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Description 

The present invention relates to positioning systems, and more particularly, to a positioning system and method 
for determining the terrestrial position of an autonomous vehicle on or near the planet Earth's surlace. 

5 Several national governments, including the United States (U.S.) of America, are presently developing a terrestrial 

position determination system, referred to generically as a global positioning system (GPS). In a GPS, a number of 
satellites are placed in orbit around the planet Earth. The GPS satellites are designed to transmit electromagnetic 
signals. From these electromagnetic signals, the absolute, terrestrial position (position with respect to the Earth's cent- 
er) of any receiver at or near the Earth's surface can ultimately be detemnined. 

70 The U.S. government has designated its GPS the 'NAVSTAR." The NAVSTAR GPS will be declared operational 

by the U.S. government in 1993. f^oreover, the govemment of the Union of Soviet Socialist Republics (U.S.S.R.) is 
currently developing a GPS known as 'GLONASS,' which is substantially similar to the NAVSTAR GPS. 

In the NAVSTAR GPS, it is envisioned that four orbiting GPS satellites will exist in each of six separate orbits. A 
total of 24 GPS satellites will be in orbit at any given time with 21 GPS satellites in operation and 3 GPS satellites 

15 sen/ing as spares. The three GPS satellite orbits will have mutually orthogonal planes relative to the Earth. The GPS 
satellite orbits will be neither polar orbits nor equatorial orbits. Moreover, the GPS satellites will orbit the Earth once 
every 12 hours. 

Using the NAVSTAR GPS, the relative position of orbiting GPS satellites with respect to any Earth receiver can 
be determined from the electromagnetic signals. The relative position is commonly referred to as a "pseudorange." 

20 Moreover, the relative position can be calculated by two methods. 

One method is to measure the propagation time delays between transmission and reception of the emanating 
electromagnetic signals. In the NAVSTAR GPS. the electromagnetic signals are encoded continuously with the time 
at which the signals are transmitted from the GPS satellites. Needless to say, one can make note of the reception time 
and subtract the encoded transmission time in order to derive time delays. From the calculated time delays and from 

2S knowing the speed at which electromagnetic waves travel through the atmosphere, pseudoranges can be accurately 
derived. Pseudoranges computed using the foregoing method are referred to in the context of this document as 'actual' 
pseudoranges. 

Another method involves satellite position data that is encoded in the electromagnetic signals being transmitted 
from the orbiting satellites. Almanac data relating to the satellite position data of the NAVSTAR GPS is publicly available. 

30 Reference to this almanac data in regard to data encoded in the electromagnetic signals allows for an accurate deri- 
vation of pseudoranges. Pseudoranges computed using the foregoing method are referred to in the context of this 
document as 'estimated' pseudoranges. 

However, with respect to the previous method of deriving estimated pseudoranges, it should be noted that the 
satellite position data is updated at the GPS satellite only once an hour on the hour Consequently, an estimated 

35 pseudorange decreases in accuracy over time after each hour until the next hour, when a new estimated pseudorange 
is computed using updated satellite position data.- 

Furthemiore. by knowing the relative position of at least three of the orbiting GPS satellites, the absolute terrestrial 
position (that is. longitude, latitude, and altitude with respect tothe Earth's center) of any Earth receiver can be computed 
via simple geometric theory involving triangulation methods. The accuracy of the terrestrial position estimate depends 

40 in part on the number of orbiting GPS satellites that are sampled. Using more GPS satellites in the computation can 
increase the accuracy of the terrestrial position estimate. 

Conventionally, four GPS satellites are sampled to determine each terrestrial position estimate because of errors 
contributed by circuit clock differentials among the Earth receiver and the various GPS satellites. Clock differentials 
could be several milliseconds. If the Earth receiver's clock were synchronized with that of the GPS satellites, then only 

<s three GPS satellites would need to be sampled to pinpoint the location of the Earth receiver. 

In the NAVSTAR GPS, electromagnetic signals are continuously transmitted from all of the GPS satellites at a 
single carrier frequency However, each of the GPS satellites has a different modulation scheme, thereby allowing for 
differentiation of the signals. In the NAVSTAR GPS, the carrier frequency is modulated using a pseudorandom signal 
which is unique to each GPS satellite. Consequently, the orbiting GPS satellites in the NAVSTAR GPS can be identified 

so when the carrier frequencies are demodulated. 

Furthermore, the NAVSTAR GPS envisions two modes of modulating the carrier wave using pseudorandom 
number (PRN) signals. In one mode, referred to as the 'coarse/acquisition" (C/A) mode, the PRN signal is a gold code 
sequence having a chip rate of 1.023 MHz. The gold code sequence is a well-known conventional pseudorandom 
sequence in the art. A chip is one individual pulse of the pseudorandom code. The chip rate o1 a pseudorandom code 

55 sequence is the rate at which the chips in the sequence are generated. Consequently the chip rate is equal to the 
code repetition rate divided by the number of members in the code. Accordingly with respect to the coarse/acquisition 
mode of the NAVSTAR GPS, there exists 1 ,023 chips in each gold code sequence and the sequence is repeated once 
every millisecond. Use of the 1.023 MHz gold code sequence from four orbiting GPS satellites enables the terrestrial 
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position of an Earth receiver to be determined to an approximate accuracy of within 60 to 300 meters. 

The second mode of modulation in the NAVSTAR GPS is commonly referred to as the "precise" or "protected" (P) 
mode. In the P mode, the pseudorandom code has a chip rate of 10.23 MHz. Moreover the P mode sequences are 
extremely long, so that the sequences repeat no more than once every 267 days. As a result, the terrestrial position 
5 of any Earth receiver can be determined to within an approximate accuracy of 16 to 30 meters. 

However, the P mode sequences are classified and are not made publicly available by the United States govern- 
ment. In other words, the P mode is intended for use only by Earth receivers authorized by the United States govern- 
ment. 

In order for the Earth receivers to differentiate the various C/A signals from the different orbiting GPS satellites. 
10 the Earth receivers usually include a plurality of different gold code sources for locally generating gold code sequences. 
Each locally-derived gold code sequence corresponds with each unique gold code sequence from each of the GPS 
satellites. 

The locally-derived gold code sequences and the transmitted gold code sequences are cross correlated with each 
other over gold code sequence intervals of one millisecond. The phase of the locally-derived gold code sequences 
IS vary on a chip-by-chip basis, and then within a chip, until the maximum cross correlation function is obtained. Because 
the cross correlation for two gold code sequences having a length of 1 =023 bits is approximately 1 6 times as great as 
the cross correlation function of any of the other combinations of gold code sequences, it is relatively easy to lock the 
locally derived gold code sequence onto the same gold code sequence that was transmitted by one of the GPS sat- 
ellites. 

20 The gold code sequences from at least four of the GPS satellites in the field of view of an Earth receiver are 

separated in this manner by using a single channel that is sequentially responsive to each of the locally-derived gold 
code sequences, or alternatively, by using parallel channels that are simultaneously responsive to the different gold 
code sequences. After four locally -derived gold code sequences are locked in phase with thp gold code sequences 
received from four GPS satellites in the field of view of the Earth receiver, the relative position of the Earth receiver 

25 can be determined to an accuracy of approximately 60 to 300 meters. 

The foregoing approximate accuracy of the NAVSTAR GPS is affected by (1) the number of GPS satellites trans- 
mitting signals to which the Earth receiver is effectively responsive, (2) the variable amplitudes of the received signals, 
and (3) the magnitude of the cross correlation peaks between the received signals from the different GPS satellites. 
Because multiple PRN signals are received simultaneously at the Earth receiver, a common time interval exists 

30 wherein some of the codes can conflict. In other words, the codes cause a degradation in measurements of the time 
of arrival of each received PRN because of the cross correlations between conflicting received signals. 

The time of arrival measurement for each PRN signal is made by determining the time of a peak amplitude of a 
cross correlation between the gold code sequence of the received PRN signal and the locally- derived PRN signal. 
When a locally-derived PRN signal is superimposed over a received PRN signal thereby increasing the averaging time 

35 of their cross correlation, the average noise contribution decreases. However, because the cross correlation errors 
between the received PRN signals are periodic, increasing the averaging time also results in increases to both the 
error signal and the cross correlation value between the received PRN's alike. Consequently errors relating to the time 
of arrival of PRN signals are not reduced by cross correlation. 

Moreover, in PROCEEDINGS OF THE IEEE, vol.77, no. 11, November 1989. NEW YORK US pages 1709 - 1727. 

40 'Applicability of an Augmented GPS for Navigation in the National Airspace Sytem' L. SCHUCHMAN ET AL. describes 
the so called differential GPS (DGPS). 

In addition to the GPS, it is known in the conventional art to use inerlial systems in navigation systems to obtain 
position estimates of vehicles. Such an inertial reference unit (IRU) obtains specific-force measurements from accel- 
erometers in a reference coordinate frame which is stabilized by gyroscopes, or gyros. An IRU can be of several types, 

^5 including for example, laser, mechanical, or fiber optic. In an unaided navigation system using an IRU, the specific 
force (corrected for the effects of the Earth's gravity) as measured by an accelerometer is integrated into a navigation 
mathematical equation to produce the vehicle's position and velocity. 

The instrument measurements of the IRU may be specified in a different rectangular coordinate frame than the 
reference navigation frame, depending on the platfornn implementation. The most commonly used reference navigation 

50 frame for near Earth navigation is the local-level frame (east- north -vertical). Several gimbal led platform implementa- 
tions exist with the forgoing reference navigation frame. 

In a gimballed, local level-north seeking I RU. the gyroscopes and accelerometers are mounted on a platform which 
is torqued to maintain the platform level and azimuth pointing to the north. The platform is the reference plane. In 
contrast, in a gimballed. local-level azimuth-wander IRU. the platform is maintained level, but is not torqued about the 

55 vertical axis. 

Furthermore, in a strap-down IRU, the gyroscopes and the accelerometers are directly mounted on the vehicle 
body They measure the linear and angular motion of the vehicle relative to inertial space. The motion is expressed in 
vehicle coordinates. Therefore, in a strap-down IRU, it is necessary to first compute the attitude of the vehicle to the 
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referenced navigation frame. Tfien, the computed altitude is used to transform the accelerometer measurements into 
the reference frame. After the accelerometer data of a strap-down IRU has been extrapolated intothe reference frame, 
the solution of the navigation equations mentioned previously is identical in both the gimballed IRU and the strap-down 
IRU 

5 In the strap-down IRU, the altitude computations, which are required to resolve accelerometer measurements, are 

usually carried out at a high rate. The computations sutler from numerical errors because of the limited computer byte 
size and throughput availability. These computation errors depend on the frequency response of the sensor loop, data 
rate and resolution and magnitude of the sensor output at the sampling time. 

However significant benefits arise from using the strap-down IRU, rather than the gimballed IRU. The s rap^Jown 
10 IRUs are less costly Iwloreover. the strap-down IRUs are generally smaller in physical size. Thus, the potential to realize 
size and cost savings in IRUs can make strap-down IRUs attractK/e for both milrtary and commercial applications. 

The performance of navigation systems using IRUs is primarily limited by errors contributed by the various con- 
strtuent sensors within the IRUs. Gyroscopes drift. Accelerometers have inherent biases. Further, errors are contnbuted 
from improper scale factors and improper IRU alignment angles. Typically, the preceding errors cause inaccuracies in 
IS the estimates of vehicle positions, velocity, and altitude, which accumulate over time as a vehicle mission progresses. 
To some extent, the errors are dependent on user dynamics. 

If a very accurate navigation system is required for a vehicle, high precision gyroscopes and accelerometers can 
be utilized to satisfy that need. However, such high precision equipment increase the complexity and costs of the 

20 The present invention is a vehicle positioning system which, as used throughout, means apparatus, method, or a 

combination of both apparatus and method. The present invention overcomes many of the limitations of conventional 
technology in the art of vehicle position determination. 

The present invention can be used toaid any navigation system for autonomous vehicles. The autonomous vehicles 
can be stationary or moving. Moreover, the autonomous vehicles can be at or near the Earth's surface. In other words, 
iS the present invention provides for highly accurate and fast tracking of any terrestrial vehicle. ^ 
The present invention envisions combining and greatly enhancing the conventional capabilities of an IRU and a 
GPS in a cost-effective manner to provide extremely accurate position estimates of terrestrial vehicles. In doing so, 
the present invention uses many novel and inventive systems, including apparatuses and methods, which allow for a 
superior positioning capability and, consequently, a flexible autonomous navigational capability 
30 The present invention further envisions a novel and enhanced combination of three independent subsystems to 

determine position estimates of vehicles on or near the Earth's surtace. One subsystem is a first positioning system 
using a GPS for example, the NAVSTAR GPS. The first positioning system computes a first position estimate of a 
vehicle Another subsystem is a second positbning system using an IRU and a vehicle odometer. The second posi- 
tioning system computes a second position estimate. The final subsystem is a processing system for computing the 
35 more accurate, third position estimate of the vehicle based upon the first and second position estimates from the 
previoustwo subsystems. , 

The present invention envisions a constellation effects method. The constellation effects method provides for se- 
- lecting the optimal satellite constellation from a larger group of GPS satellites in view of a vehicle to thereby increase 
the accuracy of first position estimates derived from a GPS. 
40 The present invention increases the accuracy of vehicle position estimates by providing differential correction 

techniques/methods which compensate for noise and errors in positioning data obtained from a GPS and/or an IRU. 
In the preferred embodiment, a base station sen/ing as a reference point can perform the differential correction tech- 
niques/methods and can then relay the obtained data to a vehicle. The vehicle can then use the data received from 
the base station to enhance the accuracy of the position estimates of the vehicle. 
4S The present invention envisions a parabolic bias technique for increasing the accuracy of GPS data received from 
GPS satellites A parabolic bias is derived for each GPS satellite to enhance actual pseudoranges lor that GPS satellite. 
I n the parabolic bias technique, parabolic models are constructed for the actual pseudoranges and the parabolic biases 
are extrapolated from the paratx)lic models. 

The present invention envisions a base residuals bias technique for increasing the accuracy of GPS data received 
so from GPS satellites. A base residuals bias is derived for modifying first position estimates from the VPS on a vehicle. 
A base residuals bias is a spatial bias which is the effective difference in the known position of the base station and 
its estimated position. 

The present invention includes a novel satellite position predictor method. This method allows the present invention 
to predict the future positions of GPS satellites. As a result, the accuracy and performance of the positioning system 
ss is further enhanced. 

The present invention includes a weighted path history technique for increasing the accuracy of first position es- 
timates ultimately derived from a GPS. The weighted path history technique uses previous first position estimates to 
derive a vehicle path model for testing the validity of future first position estimates. Use of the weighted path history 
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technique results in a reduction to wandering of first position estimates and in enhanced immunities to spurious position 
computations. 

The present invention further provides for anti-selective availability of data received from GPS satellites of any 
GPS. An anti-selective availability technique detects and corrects false positioning data received from any GPS. False 
5 data could be received from the NAVSTAR GPS or the GLONASS GPS (1) because of intentional tainting by the 
respective governments of the U.S. and U.S. S R. or (2) because of technical malfunctions. 

Further features and advantages of the present invention will become apparent to one of skill in the art upon 
examination of the following drawings and detailed description. It is intended that any additional features and advan- 
tages be incorporated herein. 

10 The present invention as defined in the claims can be better understood with reference to the text and to the 

following drawings. 

Figure 1 illustrates a block diagram of the preferred embodiment of the present invention; 
Figure 1 A is a block diagram 100A of the operational GPS satellites in the NAVSTAR GPS; 
IS Figure 2 illustrates four simultaneous, navigation equations regarding four GPS satellites of the NAVSTAR GPS; 

Figure 3 is a block diagram of a typical autonomous work site; 

Figure 4 is a block diagram of the interrelationships between a navigator, a vehicle VPS architecture, and vehicle 
controls of the present invention; 

Figure 5 is a block diagram illustrating elements in an autonomous control system; 
20 Figure 6 is a block diagram of the operation of a GPS; 

Figure 7 is a block diagram of a GPS processing system of the preferred emlDodiment; 
Figure 8 is a flow diagram of the GPS processing system of Figure 7; 

Figure 9 is a block diagram of an MPS, including an odometer 902 and an inertial reference unit (IRU) 904; 
Figure 10 is a block diagram of the VPS; 
25 Figure 11 is a block diagram of the VPS architecture of Figure 10; 

Figure 12 Is a btock diagram of a VPS main (I/O) processor of Figure 10; 

Figure 12A is a block diagram of a super Kalman filter of the preferred embodiment; 

Figure 1 3 is a flowchart of the constellation effects method; 

Figure 14 is a polar plot on a coordinate system 1402 illustrating a set of computed estimated pseudoranges: 
30 Figure 1 5 is a flowchart of an original bias technique; 

Figure 16 is a flowchart of a parabolic bias technique; 

Figure 17 is a flowchart of a base residuals bias technique; 

Figure 17A is a flowchart of a base correlator bias technique; 

Figure 18 is a flowchart of a method for the prediction of future satellite positions; 
3S Figure 1 9 is a flowchart of a weighted path history technique; 

Figure 20 is a graphical representation 2000 of first position estimates ot the vehicle 102 using the weighted path 

history method of Figure 19; 

Figure 20A illustrates a flowchart of the weighted path history technique of Figures 1 9 and 20; 
Figure 21 is a flowchart of an anti- selective availability technique. 

40 

I. Definitions 

(1) "Absolute position* in the context of this document refers to a position relative to the center of the Earth. Gen- 
erally an absolute position will be in reference to a vehicle or the base station, both on or near the Earth's surface. 

^5 First, second, and third position estimates are all absolute positions in the preferred embodiment of the present 

invention. 

(2) "Actual pseudorange' means an approximation of the distance between (1 ) a reference point and (2) a source 
of a terrestrial position determination system. In this document, actual pseudoranges usually refers to an approx- 

50 imation of the distance between (1) an Earth receiver and (2) GPS satellites and/or pseudolites. Actual pseudor- 

anges are approximated by first measuring the propagation time delays between transmission and reception of 
the electromagnetic signals emanated from the GPS satellites and/or pseudolites. Actual pseudoranges can be 
readily calculated by multiplying the calculated time delays by the speed of light, or 2.9979245896 * 10^ m/s. 

(3) "Anti-selective availability" refers to a method/technique/process for detecting and compensating for corrupted 
GPS data in the coarse/acquisition (C/A) mode of modulation. 

(4) "Base correlator bias" means a spatial bias derived in accord with the flowchart 1700A of Figure 17A. 
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(5) "Base correlator bias technique" means a method/process for computing base correlator biases. 

(6) "Base estimated position* or 'BEP' refers to the relative position o1 the base station with respect to a vehicle. 
The BEP is used in the base correlator bias technique of Part lLF.2.d. of this document. 

(7) -Base known position" or "BKP" is the absolute position of the base station (used as a reference point) which 
is known. The BKP can be an estimate itself, derived from any accurate positioning system. The BKP is assumed 
to be a more accurate estimate of the base station's absolute position than any other position estimate. 

(8) "Base position estimate" means the absolute position estimate of the base station as derived from the GPS 
processing system within the host processing system. The base position estimate is substantially similar to the 
first position estimate derived by the GPS processing system at the vehicle. The base position estimate is computed 
in the base residuals bias technique at Part 1I.F.2.C. of this document. 

(9) "Base residuals bias" means a spatial bias which is the effective difference in the base known position (BKP) 
of the base station and the position estimate of the base station which is computed by the host processing system. 

(10) "Base residuals bias technque" refers to a method for deriving base residuals biases. 

(11) "Bias" refers to a differential between two measurements, usually position estimates (spatial bias) or clock 
rates (clock bias). Because one measurement is usually known to be more accurate than another, the bias is 
oftentimes referred to as an "error. ' 

(12) "Clock bias" means the difference in the clock times between (1 ) the transmission circuitry of GPS satellites 
and/or pseudolites and (2) the reception circuitry of an Earth receiver. When using a clock bias in the computation 
ot a spatial bias, the clock bias Is multiplied by the speed of light, or 2.998 * 1 0^ meters per second. Consequently, 
the clock bias is transformed into units of length. 

(13) "Constellatbn- refers to a group comprised of GPS satellites and/or pseudolites whose signals are utilized to 
derive an absolute position estimate of a point on or near the Earth's surface. See "optimal constellation' below 

(14) "Constellation effects method' means a technique or process by which an optimal constellation of GPS sat- 
ellites is selected from a larger group of GPS satellites in view of a vehicle. 

(15) "Earth receiver" refers to any apparatus or device, or any part thereof, which receives and processes signals 
from a GPS and/or pseudolites^ Earth receivers may be situated on or near the Earth's surface. Moreover, earth 
receivers may take the form of, for example, a vehicle or a base station. 

(16) "Estimated pseudorange" refers to an approximation of the distance between (1) a reference point and (2) a 
source of a terrestrial position determination system. In this document, actual pseudoranges usually refers to an 
approximation of the distance between (1 ) an Earth receiver and (2) GPS satellites and/or pseudolites. Estimated 
pseudoranges are computed from GPS data encoded on the electromagnetic signals being transmitted from the 
GPS satellites and/or the pseudolites. Almanac equations for computing estimated pseudoranges from the GPS 
data of the NAVSTAR GPS are publicly available. 

(17) "First position estimate" or "FPE" or "FPE(i)" refers to an estimated absolute position of any vehicle which is 
outputted. in any form, from the GPS. The first position estimate and a second position estimate are independently 
derived in the present invention. Subsequently, these estimates are combined and filtered to derive a third position 
estimate. Consequently, the accuracy ot the first position estimate affects the accuracy of the third position estimate. 

(18) "Global positioning system" or "GPS" is a type of terrestrial position determination system. In a GPS. a number 
of satellites are placed in orbit around the planet Earth. The GPS satellites are designed to transmit electromagnetic 
signals. Frcxn these electromagnetic signals, the absolute, terrestnal position (position with respect to the Earth's 
center) of any receiver at or near the Earth's surface can ultimately be determined. The U.S. government has 
designated its GPS the "NAVSTAR." The govemment of the U.S.S.R. has designated its GPS the "GLONASS." 



(19) "GPS data" means all data encoded on signals transmitted from GPS satellites of a GPS. GPS data includes, 
for example, ephemeris data and time data. 
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(20) "GPS processing system" refers to the system of the present invention for receiving signals from a terrestrial 
position determination system and for deriving first position estimates of vehicles from the received signals. In the 
. preferred embodiment, the GPS processing system receives electromagnetic signals from GPS satellites of a GPS 
and/or from pseudolites. 

5 

(21) "Host processing system' refers to a computer system which is operating at the base station for performing 
methods and techniques which increase the accuracy of position estimates of vehicles. Data derived from these 
.methods and techniques is transmitted to vehicles so that the vehicles can use the data when computing first, 
second, and third position estimates. I n the preferred embodiment, the architecture/hardware of the host processing 

10 system is substantially similar to the architectureyhardware of the VPS. 

(22) "Inertlal reference unit" or "IRU" refers to a system, usually on-board a vehicle, for aiding in the derivation of 
a second position estimate of the vehicle. An IRU obtains specific-force measurements from accelerometers in a 
reference coordinate frame which is stabilized by gyroscopes, or gyros. An IRU can be of a laser type or a me- 

15 chanical type. In an unaided navigation system using an IRU, the specific force (corrected for the effects of the 

Earth's gravity] as measured by an accelerometer is integrated into a navigation mathematical equation to produce 
the vehicle's position and velocity In the preferred embodiment, the IRU is part of the MPS. 

(23) "Kalman filter" is used in its conventional sense. It refers to a software program for filtering out noise or errors 
20 in data. In the preferred embodiment, a GPS Kalman filter is utilized to filter out noise or errors in the GPS processing 

system in order to enhance the accuracy of first position estimates. Also, a VPS Kalman filter is utilized to filter 
out noise in the VPS in order to enhance the accuracy of second positbn estimates. 

(24) "Motion positioning system" or "MPS" means a system comprising at least an IRU and a vehicle odometer 
25 In the preferred embodiment, the MPS derives the second position estimate of any vehicle on or near the Earth's 

surface. Moreover, an MPS need not be present at the base station due to its stationary nature. 

(25) "Optimal constellation" means a satellite constellation in which the relative positions of the GPS satellites in 
space affords superior triangulation capabilities in order to derive the most accurate estimate of a point on or near 

30 the Earth's surface. 

(26) 'Original bias" means a spatial bias calculated by subtracting both estimated pseudoranges and clock biases 
(in units of length) from actual pseudoranges. Clock biases are transformed into units of length by multiplying them 
by the speed of light, or 2.9979245893 ♦ 10^ meters per second. 

35 

(27) 'Original bias technique" is a method for computing original biases. 

(28) "Parabolic bias' is a spatial bias computed by constructing parabolic models for the actual pseudoranges of 
each obsen/ed GPS satellite and extrapolating values from the parabolic models. In the preferred embodiment, 

40 the parabolic biases are the actual pseudoranges minus the value extrapolated from the constructed parabolic 

models and minus the clock biases (in units of length, via multiplying by the speed of light). 

(29) 'Parabolic bias technique" is a method for computing parabolic biases for each of the GPS satellites that are 
utilized. 

45 

(30) 'Pseudolite' refers to a radiating system on or near the Earth's surface for emulating a GPS satellite. In the 
preferred embodiment, electromagnetic signals, similar to those from GPS satellites, are transmitted from land- 
based pseudolites. One or more pseudolites can be used to emulate GPS satellites to enhance the computation 
of first position estimates. 

50 

(31) "Pseudolite data' means all data encoded on signals received from pseudolites. Pseudolite data resembles 
GPS data in many respects and includes similar information. 

(32) 'Pseudorange" means the distance between a source of a terrestrial position determination system and a 
ss point on or near the Earth's surface. In the preferred embodiment, sources can be GPS satellites and/or pseudolites. 

The terrestrial position determination system can be a GPS used with pseudolites, if any Further, the point on or 
near the Earth's surface can be the base station and/or vehicles. 
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(33) -Satellite position predictor" is a method for determining the future positions of GPS satellites. The method 
allows for the selection of optimal constellations ahead of time. 

(34) "Second position estimate" or "SPE" refers to an estimated absolute position of any vehicle which is oulputted, 
in any form, from the MPS. Second position estimates include at least position information from an IRU. The second 
position estimate could Include position infonnation from a vehicle odometer situated on a vehicle. 

(35) "Spatial bias" refers to a bias related to approximations of positions in two^Jimensional or three-dimensional 
space Spatial biases are used to offset a position estimate to enhance the accuracy of the position estimate. 
Spatial biases can be computed by a number of different methods of the present Invention. '"'='"ded in these 
methods are, for example, an original bias technique 1500 (Part II.F.2.a.), a parabolic bias technique 1600 Part 
II.F.2.b.), a base residuals bias technique 1700 (Part II.F.2.C.), and a base correlator bias technique 1700A (Part 
II.F.2.d.). 

(36) "Position determination system" means any system having sources which emanate signals which can be used 
by a receiver of the signals to estimate the relative distance between the sources and the receiver The signals 
may be in the form of. for example, electromagnetic waves, percussion waves, and/or sound waves. 

(37) "Terrestrial position determination system" means any position determination system which can be used to 
ultimately estimate the terrestrial position of an Earth receiver. The signals may be In the form of, for exarnple, 
electromagnetic waves, percussion waves, and/or sound waves. In the preferred embodiment, the terrestrial po- 
sition determination system Is the NAVSTAR GPS. 

(38) "Third position estimate" or "TPE" refers an estimated absolute position of any vehicle that is outputted, in 
any form from the VPS. Third position estimates are more accurate position estimates of vehicle positions than 
the first and second position estimates. Third position are derived by the VPS processing system from the first and 
second position estimates. 

(39) "Vehicle positioning system" or "VPS" refers to the system of the present Invention for deriving position esti- 
mates of any vehicle. The position estimates from the VPS are extremely accurate and can be used by a navigation 
system on any vehicle to accurately guide the vehicle. In the preferred embodiment, position estimates from the 
VPS are referred to as third position estimates. 

(40) "VPS processing system" means the processing system of the VPS. The VPS processing system derives 
third position estimates from the first and second position estimates. The architecture is depicted in Figures 10 
and 11. • ■ ■• 

(41) "Weighted combiner" refers to a particular soltware program which processes data. Inputted data is assigned 
a predetermined weighing factor based on the estimated accuracy ol the data and the technique used to gather 
the data For example, in the preferred embodiment, the first position estimate of the GPS signal 716 is weighted 
heavier than the second position estimate of the IRU signal 910 because the former Is inherently more accurate^ 
Furthermore the velocity measured by the IRU can be weighted heavier than the velocity measured by the GPS 
processing system because the former is more accurate. In the preferred embodiment, the velocity measured by 
the GPS processing system Is not used at all, but could be used In other implementations. 

(42) "Weighted path history technique' is a method or process for increasing the accu racy of first position estimates 
outputted from the GPS processing system. The technique uses previous first position estimates to derive a vehicle 
path model for testing the validity of future llrst position estimates. Use of the weighted path history technique 
results in a reduction to wandering of first position estimates and in enhanced immunities to spurious position 
computations. 

II. General Ovenriew 

Figure 1 illustrates a high level block diagram 100 ol the preferred embodiment of the present invention. To provide 
for the accurate autonomous operation of a vehicle 102 on or near the Earth's surface, the present invention includes 
both a vehicle posHioning system (VPS) 1 000 and a navigatiai system 1022. Both of these systems include apparatus, 
methods and techniques which, when integrated together, provide lor highly accurate control of unmanned vehicles. 
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A. Vehicle Positioning System (VPS) 

The task of guiding the autonomous vehicle 102 along a prescribed path requires, among other things, an accurate 
estimate of the vehicle's current position relative to some reference point. Once the current position is known, the 
5 vehicle 102 can be commanded to proceed to its next destination. 

Using the VPS 1000 of the present invention, position estimates of the vehicle 102 can be determined with extreme 
preciseness. The VPS 1000 receives GPS data from GPS satellites 104 of a GPS, such as the NAVSTAR GPS or the 
GLONASS GPS. 

In the preferred embodiment, the NAVSTAR GPS is utilized. Figure 1 A illustrates the NAVSTAR GPS. GPS satellites 
TO 130-168 travel around the Earth 172 in six orbits 174-184. 

Referring back to Figure 1, the VPS 1000 also may receive pseudolite data from a pseudolite(s) 105. The term 
"pseudolite' in the context of this document means a radiating device on or near the Earth's surface for emulating a 
GPS satellite. 

From the GPS data and/or the pseudolite data, the VPS 1 000 derives accurate estimates of position of the vehicle 
15 1 02 . The GPS data and/or the pseudolite data is significantly enhanced via numerous inventive techniques and methods 
of the present Invention to enhance the accuracy of vehicle position estimates. 

More specifically, the VPS 1000 of the preferred embodiment is a positioning system based on the incorporation 
of GPS data from the NAVSTAR GPS 104 and from a motion positioning system 900, In the preferred embodiment, 
the motion positioning system 900 comprises an inertial reference unit (IRU) 904 and/or a vehicle odometer 902. The 
'20 IRU 904 comprises a laser gyroscope(s) 106 and an acceierometer(s) 108 which can be used to produce position, 
velocity, roll, pitch and yaw data. The vehicle odometer 902 produces data on the distance travelled by the vehicle 1 02. 

A first position estimate of the vehicle 102 is derived by the GPS processing system 700 from GPS data received 
from the GPS satellites 104 and from the pseudolite data received from the pseudolite(s) 105. To increase the accuracy 
of the first position estimate the present invention implements a number of methods discussed in detail below. In 
25 addition, a second position estimate is derived by the MPS intercommunications processor 906 of the motion positioning 
system 900, which comprises the IRU 904 and/or the vehicle odometer 902. 

As shown by respective arrows 112 and 114, the first position estimate and the second position estimate are then 
combined and filtered by a VPS processing system 1 1 6. The result as shown by an output arrow 11 B is a more accurate, 
third position estimate. 

30 , 

B. Navigation System 

The navigation system 1022 receives the third position estimate from the VPS 1000. The navigation system 1022 
uses the precise, third position estimate to accurately navigate the vehicle 102. A primary purpose of the navigation 
35 system 1022 is to guide the vehicle 102 between points along pre-established or dynamically-generated paths. 

In the preferred embodiment, the navigation system 1022 is situated on the vehicle 102 itself. In other words, it is 
essentially an "on-board" system. Moreover, the navigation system 1022 may be designed to be retro-fitted into the 
vehicle 102. 

So that the navigation system 1022 can guide the vehicle 102 to follow the pre-established or dynamically-gener- 
40 ated paths, various models or conceptual representations are generated and utilized. For example, lines and arcs may 
be used to establish vehicle paths between objective points. Mathematical B-splines or clothoid curves may be used 
to model the actual path where the vehicle 102 is to navigate. These mathematical curves will be discussed in detail 
later in this document. 

Using the above modelling or representatbnal techniques provides for enhanced data communications, storage. 
45 and handling of the vehicle 102. The techniques further allow for simplification of supervisory tasks by providing a 
hierarchy o1 control and communication. The higher that a level of control exists on the hierarchical control scheme, 
the simpler the task and the more compact the commands. 

The navigation system 1022 further provides for controlling the vehicle's mechanical systems, such as brakes, 
steering, and engine and transmission, to effect the necessary physical acts required to move, stop, and steer the 
50 vehicle 102. 

The navigation system 1022 also checks the actual position of the vehicle 102 against the desired position to 
correct vehicle control in accord with the desired position. The navigation system 1022 may run multi-state models to 
enhance this checking capability. The navigation system 1022 also checks for errors or failures in the system itself and 
vehicle components. If errors or failures are detected, the navigation system 1022 can provide for fail-safe shutdown 
55 by bringing the vehicle 102 to a complete stop. 

The navigation system 1 022 further provides for different modes of controlling the vehicle 1 02. These include ( 1 ) 
a fully autonomous mode, where navigation of the vehicle 102 is automatically handled by the navigation system 1022; 
(2) a tele or remote control mode, where a remote human operator (not shown) may control the direction and motion. 
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and so on. of the vehicle 102; and (3) a manual mode, where a human operator sitting in the vehicle 102 can take 
control of the vehicle 1 02 and drive it manually. 

In the autonomous mode, obstacle detection is critical because if the vehicle 102 is not under control then it could 
cause great damage to property and great injury to life. The navigation system 1022 can efficiently detect obstacles. 

5 Boulders animals, people, trees, or other obstructions may enter the path of the vehicle 1 02 unexpectedly The nav- 
igation system 102 is capable of detecting these obstacles, either stopping or plotting a path around the obstruction, 
and returning the vehicle 1 02 to Its original route when the route is deemed safe. 

Accurately tracking the desired route is another function of the navigation system 1022. The functioning and ar- 
chitecture of the navigation system 1022 has been designed for real time tracking of vehicle paths at speeds of up to 

10 approximately 30 miles per hour (mph). 

C. Base Statkxi 

The present invention can comprise a host processing system 186 at a base station 18B. The host processing 
IS system 1 86 performs functions for both the VPS 1 000 and the navigation system 1 022. ^ ,. ^ . 

With respect to the VPS 1000. the host processing system 186 receives GPS data and/or pseudolite data, as 
shown by respective arrows 190 and 192. In effect, the host processing system IBS as well as the base station 188 
can serve as a known referencis point to improve the accuracy of vehicle position estimates as discussed in detail below 
The host processing system 1 86 implements a number of methods for increasing the accuracy of vehicle position 
20 estimates The satellite position predictor method 1800 (Part II.G.) discussed above is also implemented by the host 
processing system 1 86. The host processing system 186 will recognize the same satellite constellation that is observed 

bythe vehicle 102. . ^ 

Calculations are performed on the GPS data and/or pseudolite data to derive biases. The term bias in the context 
of this document refers to a differential between two measurements, usually position estimates (spatial bias) or clock 
25 rates (clock bias). Because one measurement is usually known to be more accurate than another the bias is oftentimes 

referred to as an "error." , j ^ ■ 

To compute spatial biases, the host processing system 186 implements a number of methods. Included in these 
methods are, for example, an orighal bias technique 1500 (Part II.F.2.a.), a parabolic bias technique 1600 (Part II. F. 
2 b ) a base residuals bias technique 1700 (Part II.F.2.C.), and a base correlator bias technique 1700A (Part II.F.2.d.). 
30 The foregoing differential correction techniques compensate for data errors. In other words, the biases computed 

at the host processing system 1 86 are Indicative of data errors. As shown by an arrow 1 94, the biases are transmitted 
to the GPS processing system 700 of the vehicle 102. The GPS processing system 700 uses these biases to eliminate 
errors in vehicle position estimates. 

■ The host processing system 186 further provides functions relating to the navigation system 1022 of the present 
3S invention The host processing system 186 serves as the highest level of control of the navigation system 1022, as 
indicated by an arrow 196. It handles scheduling and dispatching of the vehicle 1 02 with much the same results as a 
human dispatcher would achieve. Consequently the host processing system 1 86 can thereby detemnine the work cycle 
of the vehicle 102. 

The host processing system 1 86 commands the vehicle 102 to proceed from a current position to a future position 
40 via a specified route, so that the vehicle 102 may accomplish its work goals. The host processing system 186 can 
specify the vehicle routes by name, rather than by listing each point along the route, as is the case conventionally 
Accordingly, the vehicle's on-board navigation system 1 022 looks up the named vehicle route and translates the named 
vehicle route into sets of nodes and segments along the named vehicle route. 

45 II Vehicle Positioning System 

A. Oven/iew 

The foltowing discussion relative to the VPS 1000 will make specific reference to Figures 7 through 21. Figures 
so 10 and 11 show the architecture/hardware of the VPS 1000. The VPS 1000 is a highly accurate position determination 
system for a moving or stationary vehicle 102 on or near the Earth's surface. 

Recall that the VPS 1000 includes the GPS processing system 700 and the MPS 900, which are shown in respective 
Figures 7 and 9. Further recall that the MPS 900 includes the IRU 904 and the vehicle odometer 902, which are both 
shown in Figure 9. In effect, these systems have been enhanced and integrated by the present invention to produce 
55 a highly effective position determining system. 

Referring to Figure 7, the GPS processing system 700 includes an antenna 702 connected to a GPS receiver 705. 
When the GPS satellites 104 in view of antenna 702 comprise multiple GPS satellites 200-206 as shown in Figures 2 
and 3, the GPS receiver 706 reads each of their GPS data along with any pseudolite data from any pseudolite(s) 105 
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in view of antenna 702. In the preferred embodiment, the GPS receiver 706 is responsible for computing the first 
position estimate of the vehicle 102 from the GPS data and/or the pseudolite data. 

To increase the accuracy of the first position method, a satellite position predictor method 1800 (Part II.G.) is 
implemented by a GPS processor 710 of the GPS processing system 700. The satellite position predictor method 1 800 

5 predicts the position of any GPS satellite at the current time or any future time. 

Using the satellite position information, the GPS processing system 700 can determine the optimum GPS satellite 
constellation to recognize by using a constellation eflects method 1300 (Part II.F.). The constellation effects method 
1 300 is also implemented by the GPS processor 71 0 in the preferred embodiment. Pursuant to the constellation eflects 
method 1300, a best constellation is selected from the data sources comprising the GPS satellites 200-205 and pseu- 

w dolite(s)105. 

The GPS processor 706 computes a first position estimate of the vehicle 102 based on the best constellation and 
geometry/triangulation methods. The accuracy of the first position estimate is. in part, dependent on the number of 
GPS satellites used in the computation. Each additional GPS satellite used can increase the accuracy of* the first 
position estimate. After the computation, the first position estimate of the vehicle 102 is transmitted to a VPS main 
'5 processor 1002 of Figure 10. 

Referring to Figure 9, the IRU 904 comprises laser gyroscopes and accelerometers which produce position, ve- 
locity, roll, pitch, and yaw data. The IRU 904 combines this information into a second position estimate of the vehicle 
102. The odometer 902 can be implemented to measure the distance traveled by the vehicle 102. The data from the 
IRU 9d4 and the odometer 902 is also transmitted via the MPS intercommunications processor 906 to the VPS main 
20 processor 1002, as shown in Figure 10. 

The VPS main processor 1 002 combines the second position estimate from the MPS 900 (the IRU 904 and perhaps 
the odometer 902) with the first position estimate from the GPS processing system 700 to produce a more accurate 
third position estimate. 

The VPS 1000 further implements a method of eliminating erratic or spurious, third position estimates which can 
2S cause vehicle "wandering." This method is catted the weighted path history method (Part II. H.). Essentially, the path 
history o1 the vehicle 1 02 is used to statistically determine the accuracy of future estimates of the vehicle 1 02's position. 

Referring now to Figures 1 and 3, a base station 188 provides a geographic proximate reference point for the VPS 
1 000. The base station 1 83 includes a host processing system 1 86. In the preferred embodiment, the host processing 
system 186 comprises similar a similar architecture and performs the same functions as the GPS processing system 
30 700. However, the host processing system 700 performs additional functions for increasing the accuracy of first position 
estimates. 

The satellite position predictor method 1800 (Part II.G.) is implemented by the host processing system 186, in 
addition to the GPS processing system 700 as discussed above. Accordingly, the host processing system 186 will 
recognize the same GPS satellite constellation that is observed by the vehicle 102 or include the same GPS satellite 
35 in a larger constellation. 

Calculations are performed on the GPS (lata and/or pseudolite data to derive biases, including spatial biases and 
clock biases. To compute spatial biases, the host processing system 186 implements a number of methods. Figure 15 
discloses an original bias technique 1500 (Part II.R2.a.). Figure 16 discloses a parabolic bias technique 1600 (Part 11. 
R2.b.). Figure 17 discloses abase residuals bias technique 1700 (Part II.R2.a). Figure 17A discloses a base correlator 
40 bias technique 1700A (Part ILR2.d.). 

As shown by an arrow 1 94, the spatial and clock biases are transmitted to the GPS processing system 700 of the 
vehicle 102. The GPS processing system 700 uses these biases to eliminate errors in vehicle position estimates. 

B. GPS Processing System 

45 

The GPS processing system 700 utilizes vehicle position data from a terrestrial position determination system to 
derive the first position estimate of the vehicle 102. In the preferred embodiment, the terrestrial position determination 
system comprises the NAVSTAR GPS, which is currently being developed by the U.S. government, and/or Earth- 
based pseudolites. 

so 

1. NAVSTAR GPS 

As shown in Figure 1 A, 24 man-made electronic GPS satellites 132-170 in six orbits 174-184 are currently envi- 
sioned for the NAVSTAR GPS. They are planned for deployment by 1 993. As currently envisioned, the GPS satellites 
55 132-170 will orbit the Earth 172 at an altitude of approximately 14.000 miles and encircle the globe twice a day Using 
the C mode of the NAVSTAR GPS, as will be discussed below, it will be possible to determine terrestrial positions 
within 15 meters in any weather, any time, and most areas of the Earth 172. 

As of the date of the filing of this document, there are known to be six experimental and seven operational GPS 
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satellites in orbit around the Earth 172, Further, several manufacturers are known to be designing and building GPS 
receivers, such as the GPS receiver 706 of Figure 7. As more and more GPS satellites are depbyed and operational, 
the time periods increase when three or more of the experimental GPS satellites are available each day for position 

tracking. ^- . ui -ru 

5 Moreover the location of the experimental GPS satellites (and all others once deployed) is very predictable. The 

relative position, or 'pseudorange; of these GPS satellites with respect to the GPS receiver 706 on the vehicle 102 

can be detemnined from the electromagnetic signals by two methods. 

One method is to measure the propagation time delays between transmission and reception of the emanating 

electromagnetic signals. In the NAVSTAR GPS. the electromagnetic signals are encoded continuously with the time 
10 at which the signals are transmitted from the GPS satellites. Needless to say. one can make note of the reception time 

and subtract the encoded transmission time in order to derive time delays. From the calculated time delays and from 

knowing the speed at which electromagnetic waves travel through the atmosphere, pseudoranges can be accurately 

derived. Pseudoranges computed using the foregoing method are referred to in the context of this document as 'actual" 

pseudoranges. ^ 
IS Another method involves satellite position data that is encoded in the electromagnetic signals being transmitted 

from the orbiting GPS satellites. Almanac data relating to the GPS satellite position data of the NAVSTAR GPS is 
publicly available Reference to this almanac data in regard to data encoded in the electromagnetic signals altows for 
an accurate derivation of pseudoranges if the receiver locatk)n is known. Pseudoranges computed using the foregoing 
method are referred to in the context of this document as "estimated" pseudoranges. 
20 However with respect to the previous method of deriving estimated pseudoranges. it should be noted that the 

satellite position data is updated at the GPS satellite only once an hour on the hour. Consequently, an estimated 
pseudorange decreases in accuracy over time after each hour until the next hour, when a new estimated pseudorange 
is computed using updated satellite position data. .Av/exAo 
Reference is again made to Figure 1 A of the drawings wherein the configuration of the fully- operational NAVSTAR 
2S GPS is schematically illustrated. Each of the 24 GPS satellites 1 32-170 transmits electromagnetic signals which can 
be used to determine the absolute terrestrial position (that is. longitude, latitude, and altitude with respect to the Earth 
1 72's center) of the vehicle 1 02. 

Specifically, by knowing the relative position of at least three of the orbiting GPS satellites 132-170. the absolute 
terrestrial position of the vehicle 102 can be computed via simple geometric theory involving triangulation methods. 
30 The accuracy of the terrestrial position estimate depends in part on the number of orbiting GPS satellites 132-170 that 
are sampled by the vehicle 102. The sampling of more GPS satellites 132-170 in the computation increases the ac- 
curacy of the terrestrial position estimate. Conventionally, four GPS satellites, instead of three, are sampled to deter- 
mine each terrestrial position estimate because of errors contributed by circuit clock differentials among the circuitry 
of the vehicle 1 02 and the various GPS satellites 1 32-1 70. 
35 In the NAVSTAR GPS. electromagnetic signals are continuously transmitted from all of the GPS satellites 1 32-170 

at a single carrier frequency. However, each of the GPS satellites 132-170 has a different modulation scheme, thereby 
allowing for differentiation of the electromagnetic signals. In the NAVSTAR GPS, the carrier frequency is modulated 
using a pseudorandom binary code signal (data bit stream) which is unique to each GPS satellite. The pseudorandom 
binary code signal is used to biphase modulate the carrier frequency Consequently^ the orbiting GPS satellites in the 
40 NAVSTAR GPS can be identified when the earner frequencies are demodulated. 

Furthermore, the NAVSTAR GPS envisions two modes of modulating the carrier wave using pseudorandom 
number (PRN) signals. In one mode, referred to as the "coarse/acquisition" (C/A) mode, the PRN signal is a gold code 
sequence having a chip rate of 1.023 f^Hz. The gold code sequence is a well-known conventional pseudorandom 
sequence in the art. A chip is one individual pulse of the pseudorandom code. The chip rate of a pseudorandom code 
45 sequence is the rate at which the chips in the sequence are generated. Consequently, the chip rate is equal to the 
code repetition rate divided by the number of members in the code. Accordingly, with respect to the coarse/acquisition 
mode of the NAVSTAR GPS. there exists 1 ,023 chips in each gold code sequence and the sequence is repeated once 
every millisecond. Use of the 1 .023 MHz gold code sequence from four orbiting GPS satellites enables the terrestrial 
position of the vehicle 102 to be determined to an approximate accuracy of within 60 to 300 meters. 
so The second mode of modulation in the NAVSTAR GPS is commonly referred to as the "precise" or "protected" (P) 

mode. In the P mode, the pseudorandom code has a chip rate of 10.23 MHz. Moreover, the P mode sequences thai 
are extremely long, so that the sequences repeat no more than once per 276 days. As a result, the terrestrial position 
of the vehicle 102 can be determined to within an approximate accuracy of 16 to 30 meters. 

However, the P mode sequences are classified and are not made publicly available by the United States govern- 
ss ment. In other words, the P mode is intended for use only by Earth receivers authorized by the United States govern- 
ment. 

In order for the Earth receivers to differentiate the various C/A signals from the different orbiting GPS satellites, 
Earth receivers usually include a plurality of different gold code sources for locally generating gold code sequences. 
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Each locally-derived gold code sequence corresponds with each unique gold code sequence Irom each of the GPS 
satellites. 

The locally-derived gold code sequences and the transmitted gold code sequences are cross correlated with each 
other over gold code sequence intervals of one millisecond. The phase of the locally<Jerived gold code sequences 
5 vary on a chip-by-chip basis, and then within a chip, until the maximum cross correlation function is obtained. Because 
the cross correlation for two gold code sequences having a length of 1 ,023 bits is approximately 16 times as great as 
the cross correlation function of any of the other combinations of gold code sequences, it is relatively easy to lock the 
locally derived gold code sequence onto the same gold code sequence that was transmitted by one of the GPS sat- 
ellites. 

^0 The gold code sequences from at least four of the GPS satellites in the field of view of an Earth receiver are 

separated in this manner by using a single channel that is sequentially responsive to each of the locat)y<ierived gold 
code sequences, or alternatively, by using parallel channels that are simultaneously responsive to the different gold 
code sequences. After four locally -derived gold code sequences are locked in phase with the gold code sequences 
received from four GPS satellites In the field of view of the Earth receiver, the relative position of the Earth receiver 
can be determined to an accuracy of approximately 60 to 300 meters. 

The foregoing approximate accuracy of the NAVSTAR GPS is affected by (1 ) the number of GPS satellites trans- 
mitting signals to which the Earth receiver is effectively responsive, (2) the variable amplitudes of the received signals, 
and (3) the magnitude of the cross correlation peaks between the received signals from the different GPS satellites. 
,With reference to Figure 7, the GPS processing system 700 processes the GPS data from the GPS satellites 

20 132-170 and the pseudolite data from any pseudolite(s) 105. Furthermore, the GPS receiver 706 decodes the C/A 
signals from the varbus GPS satellites 132-170. 

Figure 2 illustrates navigation equations 212 regarding four GPS satellites 200-206 of the NAVSTAR GPS. The 
four GPS satellites 200, 202, 204, and 206 have respective pseudoranges RO, R2, R4, and R5 and comprise the current 
constellation of GPS satellites 132-170 recognized by the vehicle 102. 

2S The navigation equations 212 include the clock bias between the GPS satellites 200-206 and the vehicle 1 02. 

The navigation equations 212 are used to compute the longitude and latitude of the vehicle 1 02 using the pseudoranges 
RO, R2, R4, and R6. 

As is shown in the description block 208, each of the GPS satellites 200, 202. 204, and 206 transmits GPS data 
that includes timing data (GPS time) and ephemerts data. Using the navigation equations 212, which are well-known 
30 in the conventional art and the foregoing timing data, the pseudoranges RO, R2, R4, and R6 can be estimated (called 
actual pseudoranges) by the GPS processing system 700. Furthemnore, using the foregoing ephemeris data and al- 
manac data on the Earth 1 72, the pseudoranges RO, R2: R4, and R6 can be estimated (called estimated pseudoranges) 
by the GPS processing system. 

35 2. Operation 

Turning now to Figure 6, a representative GPS constellation is shown in operation. Four GPS satellites 200, 202, 
204 and 206 are transmitting GPS data. Both the vehicle 102 and the base station 138 are receiving these signals 
from each of these GPS satellites 200, 202, 204, and 206 on their respective GPS antennas 312 and 316. In the 
^0 preferred embodiment, both the C/A code and the carrier frequency are received at GPS antennas 312 and 316 for 
processing. 

In addition to the four GPS satellites shown in the Figure 6 Is the pseudolite 105. The pseudolite(s) 105 can be 
strategically placed around the perimeter of any mine pit and can emulate the GPS satellites 200, 202, 204, and 206 
as shown in Figure 6. This arrangement can be extremely useful in situations such as a mine pit, cavity, or the like, in 

45 which mining vehicles may be out of view of one or more of the GPS satellites 200, 202, 204, and 206, because of 
topographic features such as high mine pit walls. The ground-based pseudolite(s) 105 provides additional ranging 
signals and can thus improve availability and accuracy of the positioning capability in the present invention. 

The pseudolite(s) 105 is synchronized with the GPS satellites 200, 202, 204, and 206 and has a signal structure 
that, while different, is compatible with the GPS satellites 200, 202, 204, and 206. f\/loreover, the distance (range) 

50 between the vehicle 102 and the pseudolite(s) 105 is calculated similarly as the distance between the vehrcle 102 and 
one of GPS satellites 200, 202, 204, and 206. With pseudolite(s) 105, the ranging error does not include selective 
availability nor ionospheric errors. However, other errors must be accounted for such as tropospheric, pseudolite clock 
error and mullipath errors. 

In a deep pit surface mining operation, the view of the sky from a vehicle 102 in the mine can be limited by the 
55 walls of the mine. Consequently, an adequate number of GPS satellites may not be in view for the GPS processing 
system 700 to properly derive a first position estimate. In such a case in the present invention, one or more pseudolites 
105 can serve as secondary sources. The pseudolite(s) can be placed on the rim of the mine or elsewhere. The 
pseudolite(s) 105 can be used by the vehicle 102 in conjunction with any visible GPS satellites to obtain accurate first 
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position estimates. 

It is also envisioned that other torms of secondary sources could be implemented to aid GPS satellites or to com- 
pletely eliminate the need to receive GPS data from the GPS satellites. Moreover, a laser scanning technique may 
utilized to give localized ranging data to the vehicle 102 from a secondary reference source. 

5 Communication channel 618 represents the communications link between the base station 188 and the vehicle 

102. In the preferred embodiment, the communication channel 618 comprises an electromagnetic link established by 
data-radios 620 and 622 which are transceivers. The communication channel 618 is used to transfer data between 
the base station 188 and the vehicle 102. It is envisioned that other forrr^ of communicatbn media may be utilized. 
For example, a laser scanning techniqu e may utilized to convey information from the base station 1 08 to the vehicle 1 02. 

10 The data radios 620 and 622 are located at the base station 188 and vehicle 1 02 respectively. The radios 620 and 

622 are responsible for exchanging data between the base station 1 88 and the vehicle 1 02. The type of data exchanged 
will be discussed further below. 

A radio transceiver which functions appropriately in the preferred embodiment as the data radios 620 and 622 is 
commercially available from Dataradio Ltd. of Montreal, Canada, Model Number DR-48COBZ. 

T5 Turning now to Figure 7, the preferred embodiment of a GPS processing system 700 is shown. The GPS processing 

system 700 on the vehicle 102 includes a GPS antenna 702. In the preferred embodiment, the GPS antenna 702 is 
receptive to the radio spectrum of electromagnetic radiation. However, the present invention contemplates reception 
ot any signal by which GPS satellites 132-170 might encode data. In the preferred embodiment, the GPS antenna 702 
is the commercially available antenna having Model No. CA3224 from Chu Associates Inc. of Littleton, Massachusetts. 

20 The GPS antenna 702 is coupled to a preamplifier 704 so that the signals received at the GPS antenna 702 can 

be transmitted to the preamplifier 704. The term "couple" in the context of this document means any system and method 
for establishing communication. Coupling systems and methods may include, for example, electronics, optics, and/or 
sound techniques as well as any others not expressly described herein. In the prefen-ed embodiment, coupling is 
commonly electronic and adheres to any one of numerous industry standard electronic interlaces. 

2S The preamplifier 704 amplifies and down converts the GPS data received from the GPS antenna 702 so that the 

GPS data can be processed, or decoded. The present invention contemplates any method by which the received 
signals can be amplified. In the preferred embodiment, the preamplifier 704 is the commercially available preamplifier 
having Model No. 5300. Series GPS RF/IF from Stanford Telecommunications Inc. (STel) of Santa Clara, California. 
The preamplifier 704 is coupled to a GPS receiver 706. The GPS receiver 706 processes the GPS data sent from the 

30 GPS satellites 200, 202, 204, and 206 in view of the GPS antenna 702. The GPS receiver 706 computes actual pseu- 
doranges for each of the GPS satellites 200. 202, 204, and 206. Actual pseudoranges are defined in this document 
as an estimate of the pseudoranges RO, R2, R4, and R6 which is derived from the time delay between the transmission 
ot electromagnetic signals from the GPS satellites and the reception of the electromagnetic signals by the GPS process- 
ing system 700. Moreover in the preferred embodiment, the GPS receiver 706 can process in parallel all of the actual 

3B pseudo-ranges for the GPS satellites 200. 202, 204, and 206. 

In the preferred embodiment of the present invention, the GPS receiver 706 produces this data when four or more 
GPS satellites are visible. Using the differential correction techniques described in Part 1I.F.2. of this document, the 
GPS processing system 700 can compute (at GPS processor 710) the first position estimate with an accuracy of 
approximately 25 meters when an optimal constellation of four GPS satellites 200, 202. 204, and 206 is in view. When 

40 an optima! constellation of five GPS satellites (not shown) is in view, the GPS processing system 700 of the preferred 
embodiment can compute the first position estimate with an accuracy of approximately 1 5 meters. An "optimal" con- 
stellation is one in which the relative positions of the GPS satellites in space affords superior triangulation capability, 
triangulation technology being well known in the art. 

In the preferred embodiment, the GPS receiver 706 outputs actual pseudoranges and the number of GPS satellites 

45 1 32-1 70 currently being sampled. In cases in which the number ot GPS satellites 1 32-170 viewed for a series of first 
position estimates is less than four, the VPS weighted combiner 1204 (see Figure 12 and discussion) in the preferred 
embodiment does not use the first position estimates received from the GPS processing system 700 (specifically the 
GPS processor 710) in the computation of the third position estimate. 

In the preferred embodiment, the GPS receiver 706 comprises a Model Number 5305-NSI receiver which is com- 

so merciatly available from Stanford Telecommunications Inc. However, any receiver which is capable of providing actual 
pseudoranges and the number of sampled GPS satellites may be utilized. 

Because of the type of receiver used in the preferred embodiment, the GPS receiver 706 is coupled to a GPS 
intercommunication processor 708. In the preferred embodiment, the intercommunication processor 708 is the com- 
mercially available 68000 microprocessor from Motorola Inc., of Schaumburg, Illinois, U.S.A. Any processor alone or 

ss in combination with the GPS receiver 706 for accomplishing the same purpose as described below may be utilized. 

The GPS intercommunication processor 708 is further coupled to a GPS processor 710 and a GPS Console 1 
712. The GPS intercommunication processor 708 coordinates data exchange between these three devices. Specifi- 
cally, the GPS intercommunication processor 708 receives pseudorange data from the GPS receiver 706 which it 
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passes on to the GPS processor 710. The pseudorange data includes, for example, the actual pseudoranges computed 
by the GPS receiver 706, the number of GPS satellites 200, 202, 204, and 206 currently being viewed by the GPS 
receiver 706, and other GPS data needed by the GPS processor 710 to compute the estimated pseudoranges for each 
of the GPS satellites 200, 202, 204, and 206. The GPS intercommunication processor 708 also relays status information 
regarding the GPS receiver 706 and the GPS processor 710 to the GPS Console 1712. 

The GPS Intercommunication processor 708 transmits the above information to the GPS processor 710. In the 
preferred embodiment, the GPS processor 710 comprises the 68020 microprocessor, which is commercially available 
from Motorola Inc. Figure 8 is a low level flow diagram 800 illustrating the functioning of the software in the GPS 
processor 710. 

The GPS processor 710 uses a number of algorithms and methods to process the data it receives including, for 
example, a GPS Kalman filter 802, which is shown in Figure 8. The Kalman filter 802 is well known in the conventional 
art. In the preferred embodiment, the GPS Kalman filter 802 is a module in the software of the GPS processor 710. 

In part, the function of the Kalman filter 802 is to filter out noise associated with the pseudorange data. The noise 
may include, for example, ionospheric, clock, and/or receiver noise. The GPS Kalman filter 802 of the host processing 
system 186 at the base station 188 computes spatial and clock biases which are both transmitted to the vehicle 102 
for increasing the accuracy of first position estimates (as discussed in Part II.F.2. of this document). In contrast, the 
GPS Kalman filter 802 in the vehicle 102 takes into consderation the spatial and clock biases which are received from 
the base station 1 86. 

The GPS Kalman filter 802 functions in a semi-adaptive manner. In other words, the GPS Kalman filter 802 auto- 
matically modifies its threshold of acceptable data perturbations, depending on the velocity of the vehicle 102. The 
term "perturbation' in the context of this document refers to a deviation from a regular course. The semi-adaptive 
functioning of the GPS Kalman filter 802 optimizes the response and the accuracy of the present invention. Generally 
when the vehicle 102 increases its velocity by a specified amount, the GPS Kalman filter 802 will raise its acceptable 
noise threshold. Similarly, when the vehicle 102 decreases its velocity by a specified amount the GPS Kalman filter 
802 will lower its acceptable noise threshold. This automatic optimization technique of the present invention provides 
the highest degree of accuracy under both moving and stationery conditions. 

In the best mode of the present invention, the threshold of the GPS Kalman fitter 802 does not vary continuously 
or in very minute discreet intervals. Rather, the intervals are larger discreet intervals and, therefore, less accurate than 
a continuously varying filter. However the Kalman filter 802 of the present invention is easy to implement, less costly, 
and requires less computation time than with a continuously varying fitter However, it should be noted that using a 
continuously varying filter is possible and is intended to be included herein. 

For operation, the GPS Kalman filter 302 must be given an initial value at system start-up. From the initial value 
and GPS data collected by the GPS receiver 706, the GPS Kalman filter 802 extrapolates a current state (which includes 
the first position estimate and the vehicle velocity for northing, easting and altitude). The GPS Kalman filter 802 operates 
in a cyclical manner In other words, the extrapolated current state is assumed to be the initial value for the next iteration. 
.It is combined/filtered with new GPS data (an update) to derive a new current state. 

The way that the GPS data is utilized is dependent on a priori saved file called a control file 820 The control file 
820 will detenmine the following: (1) the noise threshold, (2) the speed of response, (3) the initial states of vehicle 
position and velocity, (4) the extent of deviation before a reset of the GPS Kalman filter 802 occurs, (5) the number o1 
bad measurements allowed, and/or (6) the time allotted between measurements. 

The GPS processor 710 then computes the estimated pseudoranges, the first position estimate, and the vehicle 
velocity (from Doppler shift) using the above current state and any biases, including the clock biases and the spatial 
biases. However, the GPS processor 710 discards the computed velocity data when the C/A code, rather than the 
carrier frequency, is utilized by the GPS receiver 706 to derive the vehicle velocity. The rationale for discarding the 
vehicle velocity is that experimentatbn has shown that it is not adequately accurate when derived from the C/A code. 

Vehicle velocities derived from the carrier frequency (Doppler shift) are much more accurate than the velocities 
derived from the C/A code. In the preferred embodiment, the first estimated position (and vehicle velocity if derived 
from the carrier frequency) are encoded on GPS Signal 716 and sent on to the VPS main processor 1002 shown on 
Figure 10. 

As previously discussed, the GPS processor 710 analyzes both the carrier frequency and the C/A code. Unlike 
data demodulated from the C/A code, data may be retrieved from the carrier frequency by the GPS receiver 706 at 
approximately 50 Hz (not approximately 2 Hz, as is the case for demodulating C/A code). This increased speed allows 
the present invention to produce more precise position and velocity determinations with less error 

Figure 8 illustrates other functions of the GPS processor 710 in the preferred embodiment. However, the present 
invention contemplates any method by which GPS data can be processed to determine pseudoranges. As shown at 
a flowchart block 816, a console function controls the operation of the GPS console 2. This console function regulates 
the operation of the GPS Kalman filter 302 by providing a user interface into the filter 

The VPS communications function 813 controls the outputs of the GPS Kalman fitter 802 which are directed to the 
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VPS 1000. At a flowchart block 806, it Is shown that the GPS Kalman filter 802 requests and decodes data from the 
GPS receiver 706, which data is routed through an IPROTO function 804 shown at a flowchart block 804. 

As shown, the IPROTO function 804 resides in the GPS intercommunications processor 708 and executes tasks 
associated with the GPS intercommunications processor 708. In the preferred embodiment, the IPROTO function 804 
5 is the model number XVME-081 , which is commercially available from Xycom Inc. 

As shown at a flowchart block 810 the data transmitted over the commun'cation channel 618 enters the IPROTO 
function 804. Much of this data is ultimately destined for the GPS Kalman filter 802. The communications manager 
function shown at aflowchart block 808. coordinates the incoming datafrom the IPROTO function. The communk:ations 
manager function 808 also coordinates data received from an ICC function which is shown in a flowchart block 812. 
10 The ICC function 812 exchanges data with the data- radio 714 (via GPS intercommunications processors 720) and 
the GPS data collection device 71 8 as shown. 

The GPS console 712 is well known in the art. Many types of devices are commercially available which provide 
the desired function. One such device is commercially available from Digital Equipment Corporation of Maynard. Mas- 
sachusetts Model Number VT220. The GPS console 71 2 displays processor activity data regarding the GPS intercom- 
is munications processor 708 and the GPS processor 71 0. 

The GPS processor 710 is coupled to a GPS console 722 and a GPS communications interface processor 720. 
The GPS console 722 is well known in the art. Many types of devices are commercially available which provide the 
desired console function. One'such device is commercially available from Digital Equipment Corporation of Maynard, 
Massachusetts Model Number VT220. The GPS console 722 provides the user interfacefrom which the GPS processor 
20 710 can be activated and monitored. 

The GPS communications interface processor 720 is essentially an I/O board. It is coupled to a data-radio 714 
and a GPS data collection device 718. The GPS communications interface processor 720 coordinates data exchange 
between the GPS processor 710 and both the data-radio 714 and the GPS data collection device 716. The communi- 
cations interface processor 720 m the preferred embodiment is the model no. MVME331, which is commercially avail- 
2S able from Motorola Inc., U.S.A. 

The data-radio 714 establishes a communication link between the GPS processor 710 (through the GPS commu- 
nications interface processor 720) at the vehicle 102 to a similar data-radio 714 located at the base station 188 (see 
Figure 6). In the preferred embodiment, the data-radio 714 communicates synchronously at 9600 baud using RF fre- 
quencies. The data-radio 714 at the base station 1 88 provides periodic updates on the amount of spatial bias and clock 
30 bias for each satellite to the data-radio 714 at the vehicle 102 at a rate of 2 Hz (twice per second). Spatial and clock 
biases computed by the base station 188 will be discussed further below. 

The GPS data collection device 713 can be any of numerous common electronic processing and storage devices 
such as a desktop computer Any personal computer (PC) manufactured by the International Business Machines Cor- 
poration (IBM) of Boca Raton. Florida, U.S.A., can be implemented. 
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C. Motion Positioning System- f MPS) 



The MPS 900 of the preferred embodiment is illustrated in Figure 9. The MPS 900 derives the second position 
estimate of the vehicle 1 02. Usually this second position estimate is combined and filtered with the first position estimate 
40 to thereby derive a more accurate third position estimate. However, it is envisioned that in some instances the second 
position estimate may be utilized exclusively as the third position estimate, when the first position estimate is deemed 
to be drastically inaccurate. 

For the MPS 900, the preferred embodiment envistons the combination of the odometer 902 and the IRU 904. 
However, the IRU 904 could be utilized without the odometer 902. The odometer and the IRU 904 are coupled to an 
45 MPS intercommunications processor 906 to thereby comprise the MPS 900. IRUs and odometers are well known in 
the art and are commercially available, respectively, from Honeywell Inc. of Minneapolis, Minnesota. Model Number 
HG1050-SR01 and from Caterpillar Inc. of Peoria, Illinois, Part Number 7T6337. 

The IRU 904 comprises ring-laser gyroscopes and accelerometers of known design. The IRU 904 used in the 
preferred embodiment is a replica of the system used by Boeing 767 aircrafts to determine aircraft position, except 
so that the IRU 904 has been modified to account for the lesser dynamics (for example, velocity) that the vehicle 102 
exhibits relative to that of a 767 aircraft. 

The IRU 904 can output vehicle position at 5 Hz, velocity at 10 Hz. roll at 50 Hz, pitch at 50 Hz. and yaw data at 
50 Hz. Furthermore, in the preferred embodiment, the vehicle odometer 902 can output the distance traveled by the 
vehicle 102 at 20 Hz. 

55 The laser gyroscopes of the IRU 904, in order to function properly, must at first be given an estimate of the vehicle 

102's latitude, longitude and altitude. Using this data as a baseline position estimate, the gyroscopes then use a pre- 
defined calibration in conjunction with forces associated with the rotation of the Earth 172 to determine an estimate ot 
the vehicle 102*s current position. 
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This information is then combined by the IRU 904 with data acquired by the IRU 904 acceierometers to produce 
a more accurate, second position estimate of the vehicle's current position. The second position estimate from the IRU 
904 and the data from the vehicle odometer 902 are transmitted to the MPS intercommunications processor 906 as 
shown by respective arrows 910 and 908 of Figure 9. Arrow 114 of Figure 1 includes arrows 908 and 910. 
5 Upon experimentation, It has been determined that the IRU 904 may provide erroneous second position estimates 

of the vehicle 102 due to imprecise constituent parts. More specifically, in the preferred embodiment, it has been 
obsen^ed that the directional output of the IRU 904 has drifted counterclockwise from the direction north during oper- 
ation. The drift Is dependent upon the direction In which the vehicle 102, and consequently the IRU 904, is travelling. 

Moreover, the drift can be defined by an IRU drift equation. The IRU drift equation can be derived similar to the 
JO construction of path equations described in regard to the weighted path history technique {Part II. H.) or similar to the 
construction of parabolic equations described in regard to the parabolic bias technique (Part II.R2.b.). After derived, 
the IRU drift equation can be utilized to extrapolate more accurate second position estimates. 

In the preferred embodiment, the intercommunications processor 1002 comprises the commercially available 
68000 microprocessor from Motorola Inc. The intercommunications processor 1002 coordinates exchange of data 
'5 between the MPS 900 and the VPS 1000. Any processor with similar function as described herein may be utilized. 

D. Vehicle Positioning System (VPS) 

Turning now to Figure 10, the preferred embodiment of the architecture of the VPS 1000 is depicted. Figure 11 
20 shows in detail a diagram of the VPS 1000 connected to the GPS processing system 700 and MPS 900. 

GPS processing system 700 and MPS 900 are independently coupled to the VPS main processor 1002. The 
independent coupling is an important novel feature of the present invention. Because they are independent, the failure 
of one of the systems will not cause the other to become Inoperative. Thus, if the GPS processing system 700 is not 
operative, data can still be collected and processed by the MPS 900 and, consequently, the VPS 1000. The GPS 
25 • processing system 700 and the MPS 900 transmit signals 716, 908, 910 to the VPS main processor 1002, as shown. 
These signals contain poisltion, velocity, time, pitch, roll, yaw, and distance data (see Figures 7 and 9 and associated 
discussions). 

The VPS main processor 1002 is coupled to the VPS I/O processor 1004. The VPS main processor 1002 transmits 
a signal 1008 to a VPS I/O processor 1004, as shown. The signal 1 008 comprises the third position estimate. The third 
30 position estimate is derived from the GPS, IRU, and odometer data noted above, and more specifically the first and 
second position estimates of the vehicle 102. 

The present invention contemplates any system and method by which the signals indicated by arrows 716, 906 
and 910 can be received by the VPS main processor 1002 from the GPS processing system 700 and MPS system 
900 and forwarded to the VPS main processor 1002. The VPS main processor 1002 is the 6B020 microprocessor, 
35 which is commercially available from Motorola Inc., U.S.A. 

Figure 12 is an intermediate level block diagram 1200 of a VPS main processor 1002 of Figure 10 showing a VPS 
Kalman filter 1202 and a weighted combiner 1200. As shown, the GPS signal 716 and the odometer signal 908 are 
transmitted directly to a weighted combiner 1204. The IRU signal 910 is transmitted into a VPS Kalman filter 1202. In 
the preferred embodiment, the GPS signal 716 is transmitted at a rate of 2 Hz. The odometer signal 908 is transmitted 
-*o at a rate of 20 Hz. Moreover, the IRU signal 910, which includes the second position estimate, is transmitted at a rate 
of 50 Hz. 

The VPS Kalman filter 1202 processes the IRU signal 910, filters extraneous noise from the data, and outputs the 
processed data to the weighted combiner 1 204. Further, the VPS Kalman filter 1 202 receives a signal from the weighted 
combiner 1204, as shown by an arrow 1208, which is used to reset the VPS Kalman filter 1202 with new position 
"^5 information. 

The weighted combiner 1 204 processes the signals and gives a predetermined weighing factor to each data based 
on the estimated accuracy of data gathering technique used. Thus, in the preferred embodiment, the first position 
estimate of the GPS signal 7 1 6 is weighted heavier than the second position estimate of the I RU signal 9 1 0. The reason 
for this weighing scheme is that the first position estimate is inherently more accurate than the second position estimate 
50 from the IRU 904. 

However, velocity can be more accurately determined by the IRU. Therefore, the velocity component of the IRU 
signal 910 can be weighted heavier than the velocity component of the GPS signal 716. In the preferred embodiment 
of the present invention, the velocity component of the IRU signal 910 is used exclusive of the velocity component of 
the GPS signal 716. 

55 The weighted combiner 1204 produces an output 1206 at 20 Hz. The output 1206 contains all computed data and 

is sent to two locations: the VPS Kalman filter 1202, as shown by an arrow 1208 and the VPS I/O processor 1004. as 
shown by an arrow 1008. The output 1206 contains time information relative to the GPS satellites. The output 1206 
further contains information relative to vehicle position, velocity, yaw, pitch, and roll. Finally, note that the VPS output 
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1206 comprises the third position estimate of the vehicle 102. 

Another output shown at an arrow 1018 from the weighted combiner 1204 contains only velocity data pertaining 
to the vehicle 102. Velocity data is sent to the GPS processing system 700 from the VPS main processor 1002. The 
velocity data is used to increase the accuracy of first position estimates as is discussed hereinafter. 

5 The present invention contemplates any system and method by which the signals 716, 908, and 910 can be proc- 

essed at the VPS main processor 1 002 in accordance with theabove noted process steps. In the preferred embodiment, 
the VPS main processor 1002 is the 68020 microprocessor, which is commercially available from Motorola Inc., U.S.A. 

Figure 12A Illustrates a super Kalman filter 1200A of the present invention. The super Kalman filter 1200A is a 
system and method for processing data to increase the accuracy of position estimates of the vehicle 102. Specifically, 

to the super Kalman filter directly increases the accuracy of the first position estimate. Accordingly, the accuracy of the 
third position estimate is indirectly enhanced. In the preferred embodiment, the super Kalman filter 1200A comprises 
software within the architectures of the GPS processing system 700 at Figure 7 and the VPS 1000 at Figure 10. It is 
envisioned that the super Kalman filter 1 200A could be constructed In hardware, for example, as in an integrated circuit, 
an optical filter, or the like. 

IS As shown by the arrow an 1210. the GPS Kalman filter 802 receives first data from a terrestrial position detemii- 
nation system, which could include, for example. GPS data and/or pseudoWe data. The GPS Kalman filter 802 operates 
on the data and outputs the first position estimate (FPE). as indicated by the arrow 716. 

As shown by the arrow 91D, the VPS Kalman filter 1 202 receives MPS data from the MPS 900. The VPS Kalman 
filter operates on the MPS data and outputs the second position estimate (SPE). 

20 The weighted combiner 1204 receives the FPE andthe SPE as indicated by respective arrows 716 and 1210. The 
weighted combiner 1 204 outputs the velocity 101 8 of the vehicle 102 to the GPS Kalman filter 802. The GPS Kalman 
filter 802 adapts pursuant to the vehicle velocity 1 01 8 of the vehicle to increase the accuracy of the FPE at arrow 716. 

The GPS Kalman filter 802 can be designed to adapt in discreet time inten/als or to adapt continuously In the 
preferred embodiment, the GPS Kalman filter 802 adapts in discreet time intervals due to a balance between cost and 

25 performance. , , . . 

It is envisioned that only one Kalman filter (not shown) could be implemented to provide for an accurate terrestrial 
position determination system. More specifically it is possible to have the GPS processing system 700 and the MPS 
900 (having an odometer 902 and/or an IRU 904) connected to only one Kalman filter which derives the third position 
estimate However, such a configuration would not possess all of the favorable attributes as the preferred embodiment. 
30 The super Kalman filter of Figure 12 and 12A has the beneficial attributes of both a single Kalman filter and of 

separate Kalman filters. As configured, the GPS Kalman filter 710 and the VPS Kalman filter 1202 can continuously 
exchange data to thereby increase the accuracy of first and second position estimates. Consequently, third position 
estimates are enhanced. In a sense, a single Kalman filtering system resides between the ultimate output of the third 
position estimate and the position data being inputted. 
3S In a different sense, the GPS Kalman filter 710 and the VPS Kalman filler 1202 act entirely as separate, independent 

filters If, for example, either GPS data or MPS data is tainted, then the tainted data can be totally or partially disregarded 
via the weighted combiner 1204 without affecting the accuracy of the non-tainted data. In a system utilizing a single 
Kalman filter, the ultimate output, or third position estimate, will be substantially inaccurate if either the GPS data or 
the MPS data is substantially tainted. 
40 Referring now back to Figure 10, the VPS I/O processor 1004 is coupled to a VPS communications interface 

processor 1020. The communications interface processor 1020 is the MVME331 processor, which is commercially 
available from Motorola Inc., U.S.A. Any processor accomplishing the same purpose as described below may be uti- 
lized. ..„ , . 
In the preferred embodiment, the VPS communications interface processor 1020 is coupled to three different de- 
4S vices: (1) a VPS console 1012, (2) a data collection device 1014, and (3) the navigation system 1022. The VPS com- 
munications interface processor 1020 routes the data, including the third position estimate, contained in output 1016 
to the above three devices at a rate of 20 Hz. 

The VPS console 1012 is well known in the art, and is commercially available from Digital Equipment Corporation, 
of Minneapolis, Minnesota, Model Number VT220. This VPS console 1012 is used to display the current status of the 
so VPS I/O processor 1004. 

The VPS data collection device 1014 can be any of numerous commercially available electronic processing and 
storage devices, for example, a desktop PC. Any Macintosh PC available from Apple Computer ol Cupertino, California, 
can be used successfully to achieve this purpose. 

The navigation system 1022 comprises the features associated with the navigation of the vehicle 102. The VPS 
ss 1000 transmits the third position estimate to the navigation system 1022, so that the navigation system 1022 can 
accurately and safely guide the autonomous vehicle 102. 



18 



EP 0 604 404 B1 



E. Base Station 

With reference to Figure 7, the host processing system 1 86 at Ihe base station 1 88 comprises the GPS processing 
system 700 of Figure 7. The purposes of the host processing system 136 at the base station 188 are to (1) monitor 
the operation of the vehicle 1 02, (2) provide a knowm terrestrial reference point from which spatial biases (see differential 
bias techniques, Part II.F.2.) can be produced, and (3) provide any other information to the vehicle 1 02 when necessary 
over the high-speed data communication channel 618. 

In the preferred embodiment, the base station 188 will be located close to the vehicle 102, preferably within 20 
miles. The close geographical relationship will provide for effective radio commu nication between the base station 
188 and the vehicle 102 over the communication channel 618. It will also provide an accurate reference point for 
comparing satellite transmissions received by the vehicle 102 with those received by the base station 188. 

A geographically proximate reference point is needed in order to compute accurate spatial biases. Spatial and 
clock biases are, in effect, the common mode noise that exists inherently in the NAVSTAR GPS and the GPS processing 
system 700. Once computed at the base station 188, the spatial and clock biases are then sent to the vehicle 102 
using the data-radio 714, as shown In Figure 7. The spatial biases are computed using various methods which are 
discussed further below. 

In the preferred embodiment of the present invention, the host processing system 186 at the base station 186 
further coordinates the autonomous activities of the vehicle 1 02 and interfaces the VPS 1000 with human supervisors. 

F. Satellite Based Accuracy Improvements 

The present Invention improves the accuracy of the position estimates of the vehicle 102 via a number of differential 
correction techniques. These differential bias techniques are used to enhance the first, second, and third position 
estimates. 

Several of these differential correction techniques are designed to directly remove errors (noise or interference) 
in the calculation of pseudoranges RO^ R2. R4, and R6 (both actual and estimated pseudoranges). The removal of 
these errors results in a more precise first position estimate, which is outputted by the GPS processing system 700 to 
the VPS 1000, and ultimately, in a more precise third position estimate, which is outputted by the VPS 1000 to the 
navigation system 1022. 

In the preferred embodiment, the host processing system 186 at the base station 183 is responsible for executing 
these differential techniques and for fonwarding the results to the vehicle 102. Recall that the host processing system 
186 comprises the GPS processing system 700, just as the vehicle 102. The term "differential" is used because the 
base station 188 and the vehicle 102 use independent but virtually an identical GPS processing system 700. Further- 
more, because the base station 138 is stationary and its absolute position is known, it serves as a reference point from 
which to measure electronic errors (noise or interference) and other phenomena inducing errors. 

1 . Constellation Effects 

Figure 13 is a flowchart 1300 of the constellation effects method for improving the accuracy of first position esti- 
mates in the preferred embodiment of the present invention. The method may be implemented in the GPS processing 
system 700 at the vehicle 102. Alternatively, the method may be implemented in the host processing system 186 at 
the base station 1 88. 1 n the latter case, the infornnation determined by the method would subsequently be communicated 
to the vehicle 102 for appropriate enhancement of first position estimates. 

The flowchart 1300 shows a method for selecting the best satellite constellation in view of the GPS antenna 702. 
For the vehicle 102, many of the GPS satellites 132-170 may be in view of the GPS antenna 702. Only a subset of 
these satellites are selected to form a particular constellation of any number of satellites (at least four in the preferred 
embodiment). 

Essentially, the 'best" or 'optimar constellation is selected based upon geometrical considerations. The location 
in space of the GPS satellites 1 32-1 70 in view of the GPS antenna and the intended path of the vehicle 1 02 are taken 
into account as will be discussed in detail below. 

The flowchart 1 300 begins at a flowchart block 1 302. At flowchart 1 304, the estimated pseudoranges of each GPS 
satellite in view of and relative to the GPS antenna 702 are computed. Estimated pseudoranges are defined in the 
context of this document as estimated pseudoranges derived from almanac data and the ephemeris from GPS satellites. 
Almanac data refers to previously recorded data which stores the location in space of the GPS satellites 132-170 at 
specific times during the day. 

For the NAVSTAR GPS, the almanac data is in the form of an equations with variables. These almanac equations 
are publicly available from the U.S. government. Some of the variables identify the GPS satellites 132-170. Further 
requisite inputs include the time at which an estimated pseudorange is to be determined and the known location of the 
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relevant point on the Earth. 

To determine the estimated pseudoranges pertaining to each GPS satellite, the (oltawing information is inserted 
into these almanac equations: {1 ) the parameters identifying the GPS satellites, which are encoded in the GPS data 
from the GPS satellites. (2) the current time, and (3) the known location of the base statton 188. 

5 Next, at flowchart block 1 306, the estimated pseudoranges are plotted using polar coordinates. Figure 1 4 is a polar 

plot 1400 on a coordinate system 1402 illustrating a set of estimated pseudoranges circles 1404, 1406, 1408, and 
1410 pertaining to a GPS satellite constellation of four GPS satellrtes (not shown). The estimated pseudorange circles 
1404. 1406, 1408, and 1410 are drawn so that an intersection exists at the center 1412 of the polar map 1400. The 
coordinate system 1402 reflects azimuth from the directkjn north as indicated. 

w The relative distances between the GPS satellites and the GPS antenna are also represented in the polar map 
1400 by the size of the estimated pseudorange circles 1404, 1406, 1408, and 1410. Specifically, for example, the GPS 
satellite represented by the estimated pseudorange circle 1406 is further away than the GPS satellite represented by 

the estimated pseudorange circle 1408. 

With reference to Figure 14, a shaded ellipsoid region 1412 shows the possible position of the vehicle 102 when 

IS the GPS satellites (not shown) giving rise to the estimated pseudorange circles 1 406 and 1 408 are considered. An 
important parameter in the ellipsoid representation is the ratio between the semi-major and semnminor access of the 
ellipsoid, called the geometric ratio of access factor (GRAF). It is envisioned that the GRAF can be computed at a next 

flowchart block 1308. ' ... 

With reference to the flowchart block 1 308. the GRAF is used along with the angle of the ma|or access to compute 

20 a weighing factor, which will ultimately assist the GPS processing system 700 to compute a more accurate first position 
estimate as described below. As shown in flowchart block 1312, the GPS Kalman filter 802 in the GPS processing 
system 700 at the vehicle 1 02 is modified to accommodate for the shape of the estimated ellipsoid and for the computed 
northing-easting coordinates of the vehicle 102. as illustrated in Figure 14. t^oreover. as indicated by an arrow 1314, 
the foregoing procedure is repeated continuously so as to continuously enhance the estimated position of the center 

25 1412. At a flowchart block 1316, the optimal satellite constellation for the desired vehicle path is determined. The 
optimal constellation will be one that gives the least error perpendicular to the desired vehicle path. 

As shown at a flowchart block 1318, the optimal satellite constellation is transmitted to the vehicle 102 over the 
data radio 714. The vehicle 102 uses the optimal satellite constellation to compute first position estimates. 

30 2. Differential Correction Techniques 
a. Orfoinal Bias Technique 

Referring now to Figure 15, a flowchart 1500 illustrates the original bias technique. v*ich is known in the conven- 
es tional art The original bias technique is a method for computing spatial biases to increase the accuracy of first position 
estimates, which ultimately participate in defining third position estimates. The original bias lechnique, descnbed in 
detail below, uses a known position of the base station 1 88 as a reference point for determining spatial biases (original 

biases). 

The original bias technique may be implemented in the GPS processing system 700 at the vehicle 102. Further- 

40 more, the original bias technique may be implemented in the host processing system 186 at the base station 188. In 
the latter approach, the information determined by the method would subsequently be communicated to the vehicle 
102 for appropriate enhancement of first position estimates. Furthermore, the preferred embodiment adopts the latter 
approach and implements the original bias technique in the host processing system 186 at the base station 188. 
The original bias technique as shown in Figure 15 begins at flowchart block 1502. As shown at a flowchart block 

45 1 504. the actual pseudorange (base actual pseudorange) and the estimated pseudorange (base estimate pseudor- 
ange) for each GPS satellite in view of the GPS antenna 702 are computed in the host processing system 185 at the 
base station 188. The base actual pseudorange is computed independently of the base estimated pseudorange. The 
base actual pseudorange is computed by the GPS receiver 706 in the host processing system 186. Moreover, the base 
estimated pseudorange is computed by the GPS processor 710. 

so Base actual pseudoranges are calculated by measuring the propagation time lapse between transmission of elec- 

tromagnetic signals from a GPS satellite (or pseudolite) and reception of the signals at the host processing system 
186 at the base station 188. The electromagnetic signals encode the time of transmission. Further, the GPS receiver 
706 records the time of reception. By assuming that these electromagnetic signals travel at the speed of light, or 
2.9979245698 * lO^ meters per second, the actual pseudorange for each satellrte can be determined by multiplying 

ss the propagation time lapse by the speed of light (in the appropriate units). 

Base estimated pseudoranges are computed from (1) almanac data (in NAVSTAR GPS. an almanac equation). 
(2) the time of transmission of the electromagnetic signals from the GPS satellites, and (3) the known position (base 
known position) of the base station 16B. The transmission time and the base known position (BKP) is inserted into the 
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almanac equation to derive an estimated pseudorange for a satellite. 

Clock biases (base clock bias) between the circuitry clocks ot the host processing system 1 86 and the recognized 
GPS satellites are also computed, as shown at the flowchart block 1604. In the preferred embodiment, one base clock 
bias is calculated for all of the satellites. The base clock bias is computed by counting clock pulses of a satellite and 
5 the host processing system 188 over a preselected time period. The pulses are then compared to derive a difference. 
The difference is then multiplied by the speed of light, or 2.998 * 10^ meters per second, so as to convert the clock 
bias into units of length. However, it should be noted that any method of computing and expressing a base clock bias 
can be incorporated into the present invention. 

As shown in flowchart block 1508, a spatial bias (original bias) is calculated by subtracting both the base estinr^ted 
10 pseudorange and the base clock bias (in units of length) from base actual pseudorange. The original bias is caused 
by many different effects, such as atmospheric conditions, receiver error, etc. It should be noted that the calculation 
of the original bias cannot be performed by using the vehicle 102 as a reference point, because the actual position of 
the vehicle 102 is not known. However, the computation of the original biases could be performed at the vehicle 102. 

As shown at a flowchart block 1510, the GPS Kaiman filter 802 in the host processing system 188 is updated with 
15 the original bias. Further as shown by an arrow 1512, the process of computing original biases is performed continu- 
ously and the derived original biases are used to iteratively update the GPS Kaiman fitter 602. 

Because the vehicle 102 is in close proximity to the base station 188, the error in the pseudorange computations 
is assumed to be identical. Therefore, the original bias which has been determined as shown in the flowchart block 
1 508 is also used to modify the actual pseudoranges produced by the GPS processing system 700 of the vehicle 102. 
20 Accordingly, as shown at a flowchart block 1514, the original biases are transmitted from the base station 183 to the 
vehicle 102 using the data radios 620 and 622; 

The original biases are used to update the GPS Kaiman filter 802 in the vehicle 102. The updating of the GPS 
Kaiman filter 802 results in more accurate first position estimates. 

2S b. Parabolic Bias Technique 

As the GPS satellites 132-170 rise and fall in the sky, the path formed by each GPS satellite 132-170 follows a 
parabola with respect to tracking pseudoranges on or near the Earth's surface. Therefore, a parabolic function can be 
derived which represents the path of each GPS satellite in the sky The foregoing describes the essence of the parabolic 
30 bias technique, which is performed in the host processing system 186 at the base station 188 in the preferred embod- 
iment. It should be noted, however, that the parabolic bias technique may be performed at the vehicle 102. 

Turning now to Figure 16, a flowchart 1600 illustrates the parabolic bias technique. A parabolic function (model) 
is computed for each GPS satellite in the view of the GPS antenna 702 at the base station 188. 

The flowchart 1600 begins at a flowchart block 1602. As shown at a flowchart block 1604, at a time t(n), 'actual 
35 pseudoranges are determined for each GPS satellite in view of the GPS antenna 702 at the base station 188, using 
the GPS receiver. 706, as described above. As shown at a flowchart block 1606, the actual pseudoranges (for each 
GPS satellite) are incorporated into parabolic best fit models for each GPS satellite. Thus, at the flowchart block 1606 
one point is added on the parabolic model for each GPS satellite. 

As shown at a flowchart block 1608, a test is made as to whether enough points on the parabolic models have 
40 been determined to estimate a parabolic function for each GPS satellite. The number of points that have been collected 
will determine a particular statistical R2 value. In the preferred embodiment, the R2 value is computed as follows; 

2 

p2_ SUM (est. p5eudorange(t) - mean of est, pseudoranges) 

2 

45 SUM (act. pseudorange(t) - mean of act. pseudoranges) 

The above standard statistical equation is well known in the conventional art. For a further discussion on this 
equation, refer to Draper. Applied Regression Analysis . 1 966 edition. By defining N as the number of calculated pseu- 
doranges, both estimated and actual, and by mathematically expanding the equation, the following more usable form 
so of the 

equation can easily be derived: 
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H * SOM(s<iuare of all Mt. pseudoranges) - 
2 ♦ SOM(est» pseudoranges) ♦ sUM(actual 
^2. poo yrtorana^ fi^ ^ RUM factual pseudoranqesl^ 
N * SUM (square of all actual pseudoranges) 
SUM (actual pseudoranges) 



As shown at the flowchart block 1608, if this R2 vaiue is greater than 0.98 in the preferred embodiment, then the 
parabolic model is deemed to be accurate enough to estimate the future path of the GPS satellite. If the value is 
less than or equal to 0.98. then more points on the parabolic model must be computed. These points are computed 
by incorporating the pseudorange data which is continually being computed by the GPS receiver 706. 
15 As shown at a flowchart block 1610, the N value increments to show that the time at which the pseudorange is 

computed, as shown in the flowchart block 1604. has increased. Because the GPS receiver 706 outputs actual pseu- 
doranges for each GPS satellite at 2 Hz (twice a second), each N increment should represent approximately one half 

second. . 

If enough data points have been collected such that the R2 value is greater than 0.98. then as shown in a flowchart 
20 block 1612, the parabolic models are deemed accurate enough to represent each satellite's orbital path. As shown m 
the flowchart block 1612, the parabolic models represent points on the past and future satellite paths. Now that the 
parabolic models are complete, future points on the models can be extrapolated, as shown at a flowchart block 1614. 

As shown at the flowchart block 1614, for the time T(n+1) the locus point on each of the parabolic models is 
computed The locus points are the expected actual pseudoranges of the GPS satellites at time T(n+1). Once this 
25 locus point is computed, the range for the locus point (distance between the GPS antenna 702 and the GPS satellite) 
is computed, as shown at a flowchart block 1616. 

At a flowchart block 1618, the actual pseudoranges are computed for time T(n+1), which is the current time in the 
preferred embodiment. The actual pseudoranges are computed by the GPS receiver 706 as described above. These 
actual pseudoranges at T(n+1) are incorporated into the parabolic best fit models dunng the next iteration of the flow- 
30 chart 1600. 

As shown at a flowchart bbck 1620, the actual pseudorange computed at time T(n+1 ) and the base clock bias (in 
units of length) for each satellite are subtracted from the locus point range to generate the parabolic bias for each 
satellite. 

As indicated in flowchart block 1624, the parabolic biases are then transmitted to the GPS processing system 700 
35 of the vehicle 102 via the data radio 714. The GPS processing system 700 at the vehicle 102 utilizes the parabolic 
biases to increase \he accuracy of its actual pseudorange (vehicle actual pseudoranges) calculations to thereby in- 
crease the accuracy of first position estimates. 



c. Base Residuals Bias Technique 



Figure 17 illustrates a flowchart 1 700 for implementing the base residuals bias technique. In the preferred embod- 
iment, the base residuals bias technique is performed in the host processing system 186 at the base station 188. After 
the base residuals bias has been computed at the base station 188. it is transmitted to the GPS processing system 
700 of the vehicle 102. The GPS processing system 700 at the vehicle 102 uses the base residuals bias to enhance 
45 the accuracy of first position estimates. 

A base residual bias in the context of this document is a difference in the base known position of the base station 
188 and the position estimate (first position estimate, if calculated by the vehicle 102) of the base station 188 which is 
computed by the host processing system 166 at the base station 168. To illustrate how this functions, assume the base 
station 1 88 is at the comer of Elm and Maple streets. Also assume the GPS processing system 700 at the base station 
50 1 88 estimates the position of the base station 188 to be tour miles due south of the base known position (the comer 
o1 Elm and Maple). It is obvious that the base residuals bias is a distance equal to four miles in a due south direction. 

Because the GPS processing system 700 on the vehicle 102 is identical to the GPS processing system 700 at the 
base station 188, the four mile error in computation can be deemed to be occurring at the vehicle 102 as well as the 
base station 1 88. The vehicle 102 can then use this information in its GPS processor 710. In effect, the GPS processor 
55 on the vehicle 102 will modify its first position estimates to account lor a four mile due south error in the data. 

The methodology of the base residuals bias technique will now be discussed in detail with reference to Figure 17. 
At a flowchart block 1704, the exact polar coordinates xO. yO, zO of the base station 188 is obtained from the base 
known position. 
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At a flowchart block 1706, base actual pseudoranges, base estimated pseudoranges, and base clock biases are 
computed by the host processing system 186 at the base station 188. If the GPS receiver 706 on the vehicle 102 is 
configured to read data from a particular constellation of GPS satellites (not shown), then the GPS receiver 706 at the 
base station 188 will use the same satellite constellation. As indicated in flowchart block 1703, a position estimate 
5 (base position estimate) of the base station 1 88 is computed. In the preferred embodiment, the base position estimate 
is computed in the same way as the first position estimate at the vehicle 102. 

Next, at a flowchart block 1 710, the base position estimate is compared to the base known position. The difference 
(such as the four mites in the above example), if any. between the base position estimate and the base known position 
is referred to in this document as the base residuals bias. 
10 The base residuals bias is transmitted to the vehicle 102 via the data radio 714. as indicated in flowchart block 

1712. The base residuals bias is processed at the GPS processor 710 of the vehicle 102 to enhance the accuracy ol 
the first position estimate. 

d. Base Correlator Bias Technique 

75 

Figure 17A illustrates a high level flowchart 1700A of a base correlator technique utilized in the present invention 
to improve the accuracy of the first position estimates of the vehicle 102. Generally, the technique involves using the 
known position of a reference point as a way of increasing accuracy In the preferred embodiment, the base station 
188 serves as the reference point. The methodology of flowchart 1700A will be discussed in detail below with specific 
20 reference to Figure 6. 

In the base correlator technique, spatial biases (base spatial biases) and clock biases (base clock biases) are 
initially computed by the host processing system 1 86 at the base station 1 68 of Figure 6. as indicated in flowchart block 
1705. The base spatial biases can be any spatial error computation including, but not limited to, the original and par- 
abolic biases discussed previously in this document. 

2S Specifically, recall that the original bias is calculated by subtracting both estimated pseudoranges (base estimated 

pseudorange) and base clock biases from actual pseudoranges (base actual pseudoranges). The base estimated 
pseudoranges are determined from (1 ) almanac data, (2) the time of transmission of the satellite signals, and (3) the 
known position (base known position) of the base station 188. The base clock biases are the differences in the clock 
times between the transmission circuitry of GPS satellites and/or pseudolites and the reception circuitry of the base 

30 station 1 88. The base clock biases are expressed in terms of units of length by multiplying them by the speed of light. 
The base actual pseudoranges are determined from the propagation time delays between transmission and reception 
of the electromagnetic signals sent from GPS satellites and/or pseudolites to the base station 188. 

IVIoreover, the parabolic bias is computed by constructing parabolic models for the base actual pseudoranges of 
each observed GPS satellite and extrapolating values from the parabolic models. In the preferred embodiment, the 

3S parabolic biases are the base actual pseudoranges minus the value extrapolated from the constructed parabolic models 
and minus the base clock biases (in units of length). . . - - 

As shown in flowchart block 1 709, the base station 1 88 transmits to the vehicle 1 02 along communication channel 
618 its base actual pseudoranges, base estimated pseudoranges, base spatial biases, base clock biases, and the 
base known position of the base station 183, Intended to be a very accurate estimate itself, the base known position 

40 can be detemnined by any appropriate means, including but not limited to, the novel systems and methods of the 
present invention or any other conventional systems and methods. After the vehicle 102 receives the foregoing infor- 
mation from the base station 188, the GPS processor 710 of the vehicle 102 uses this information in the calculation of 
its own spatial biases (vehicle spatial biases). 

Before the vehicle 102 perfomns computations to derive the vehicle spatial biases at flowchart block 1 71 3, its GPS 

45 receiver 706 computes its own actual pseudoranges (vehicle actual pseudoranges), its own estimated pseudoranges 
(vehicle estimated pseudoranges), and its own clock biases (vehicle clock biases). From the vehicle actual pseudor- 
anges, its GPS processor 710 subtracts the vehicle estimated pseudoranges, the vehicle clock biases, and the base 
spatial biases which were sent from the base station 188 in flowchart block 1709. The result is a more accurate cal- 
culation of the vehicle spatial bias at the vehicle 102. 

50 The vehicle spatial bias is then utilized to more accurately modify the first position estimate (FPE) of the vehicle 

102, as shown in flowchart block 1717. It should be noted that the FPE is an estimate of the absolute position (with 
respect to the Earth 172's center) of the vehicle 102. 

Beginning with a flowchart block 1721, an iterative method is instituted for improving the FPE of the vehicle 102. 
The method envisions using the base station 314 as a sort of correlator In the preferred embodiment, the method is 

55 implemented by the GPS Kalmari filter 802. 

At the flowchart block 1 721 , an estimated relative position (HBE) of the base station 168 with respect to the vehicle 
102 is determined. The initial state of the FPE is assumed to be the current value of FPE(i), where i is the positive 
integer value corresponding to the iteration. Consequently when the method progresses from flowchart block 1717 to 
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block 1721, the current value of FPE(i) will be FPE(O). 

Still at flowchart block 1721 , the vehicle 102 next<:alculates an estimated position (base estimated position; BEP) 
of the base statbn IBB using the base actual pseudoranges. base estimated pseudoranges, base spatial biases, and 
base clock biases which all were transferred to the vehicle 1 02 from the base station 1 88. It should be noted that the 
5 BEP is an absolute position (relative to the Earth 172's surface). By subtracting the BEP from the FPE, an estimated 
relative position (HBE) of the base station IBB with respect to the vehicle 102 is determined. 

As indicated at flowchart block 1725, an HBA is detemiined. HBA is another estimated relative position of the base 
statbn 188 with respect to the vehicle 102. However, unlike the HBE. the HBA is computed by subtracting the base 
known position (BKP) from the FPE. Thus. HBE and HBA differ in that the fomner is calculated using GPS data and/ 
JO or pseudolite data whereas the latter is calculated using the known data. ^ ^ ^ 

Next at a flowchart block 1729, an offset is computed by subtracting HBE and HBA. In the preferred embodiment 
the offset is a vector in a two- dimensional, orthogonal coordinate system. It Is envisioned that a three-dimensional 
vector may be implemented to consider elevational differences between the vehicle 102 and the base station 188. 
At a flowchart block 1733, a new FPE(i) is computed by subtracting the offset from the old FPE. In other words. 
15 the offset is used as a bias and is subtracted from the FPE(i) in order to increase the FPE(i)'s accuracy 

At flowchart block 1737. the offset is compared to a preselected threshold. In the preferred embodiment, each 
vector component has a corresponding threshold. If all the vector components are not less than their corresponding 
preselected thresholds, then the flowchart 1700A starts again at flowchart block 1721. as indicated by a feedback 
arrow 1739 In this case, the positive integer i is increased by one to indicate another iteration and a diflerent FPE(i). 
20 The present invention will operate in a cyclical, or loop-like, manner until the preselected threshold is achieved or 

■ surpassed. «cdc 
When the oftset finally achieves the preselected threshold, then the FPE is assumed to be the current state ot PPt 
(i), as shown in flowchart btock 1743. Hence, the base correlator bias technique provides lor greater accuracy of the 
FPE. 
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G. Satellite Position Predictor 



The present invention includes a method by which the future positions of the GPS satellites 1 32-170 can be pre- 
dicted with respect to a known absolute position of the base station 186 and/or the vehicle 102. The future positions 

30 are based upon estimated pseudoranges calculated by the GPS processor 710 at the host processing system 1 88 
and/ or the VPS 1000. Moreover, the computatbns can be performed at the base station 168 and/or the vehicle 102 
and transferred anywhere, if necessary. 

By predicting the future positions of the GPS satellites 132-170, optimum satellite constellations for the vehicle 
1 02 can be determined well in advance. Thus, the present inventbn can provide lor the prediction of satellite availability 

35 and unavailability in a systematic manner. It further allows for future planning related to the operation, service, and 
maintenance of the vehicle 102. 

With reference to Figure IB. a flowchart 1800 illustrates the satellite position predictor method of the present 
inventbn. At a flowchart block 1804, for a particular GPS satellite, a future date and time is obtained or selected for 
any of a number of reasons eluded to above. 

40 After a future date and time is acquired, the position of the base station 1 68 and/or the vehicle 102 is determined, 

as shown at a flowchart block 1806. In the preferred embodiment, the base station 188 is used as the reference point. 
The positron of the base station 166 could be the base known position or the base position estimate (both discussed 
in relatbn to the base residuals technique). In the preferred embodiment, the base known position is utilized and will 
be referred to hereinafter. 

45 As shown at a flowchart block 1608, the almanac data is then consulted. As discussed prevbusly in this document, 

the almanac data for the NAVSTAR GPS is in the form of almanac equations By inputting into the almanac equations 
a satellite's identity, the future dale and lime, and the base known position, the future positron of any satellite can be 
determined. 

When the future position of a satellite relative to the base statbn 1 88 is determined using the almanac equations, 
50 the future positbn is in orthogonal XYZ coordinates, as shown at a flowchart bbck 1B08. Finally in the preferred 
embodiment at a flowchart block 1 810, the latitude, longitude, elevation and azimuth of the satellite are computed from 
the XYZ coordinates and the position of the base station 188. 

From the computation of the future positions of satellites, optimal satellite constellations can be determined. Op- 
timal satellite constellations determined using the base statbn 1 68 as the relerence point can be imputed to the vehicle 
55 102 if close to the base station 1 88. 
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H. Weighted Path History 

The weighted path history technique of the present invention improves the accuracy of first position estimates of 
the vehicle 102 which are derived from the GPS processing system 700. It should be noted that the weighted path 
history technique could be implemented in an identical fashion as is described below to improve the accuracy of third 
position estimates derived by the VPS 1000. The weighted path history technique is depicted in Figures 19 and 20, 

Essentially, the weighted path history technique uses previous first position estimates to derive a vehicle path 
model for testing the validity of future first position estimates. Use of the weighted path history technique results in a 
reduction to wandering of first position estimates and in enhanced immunities to spurious position computations. The 
term 'wandering' in the context of this document means the tendency of the GPS processing system 700 to estimate 
erroneous vehicle positions that deviate from the actual path of the vehicle 102. 

With reference to Figure 19, the weighted path history flowchart begins at flowchart block 1902. A first position 
estimate of the vehicle 102 is computed and recorded by the GPS processing system 700, as indicated in a flowchart 
block 1904. First position estimates are recorded over time. As is shown in Figure 20, first position estimates 2002, 
2004, 2006, 2008, 201 0, and 201 2 of vehicle 1 02 are plotted on a diagram 2000 to ultimately derive a vehicle path 2022. 

At a flowchart block 1 906, the first position estimate is used to manipulate/derive a path equation that best fits the 
path of the vehicle 102. In other words, first positkxi estimates are accumulated over time to derive an accurate "path 
equation,' In the preferred embodiment, the path equation is a second degree (parabolic) equation. However, it should 
be noted that a third degree equation (having a mathematical infiectkxi) is envisioned for winding vehicle paths and 
vehicle turns. Furthermore, an embodiment of the present invention could utilize combinations of any types of equations 
to map an infinite number of different vehicle paths. 

At a flowchart block 1908, the statistical R2 value in relation to the path equation and the first position estimate is 
computed and compared to a threshold numerical value. In the preferred embodiment, the threshold has been set to 
0.98. The statistical R2 value was discussed in detail previously in this document. In the context of the weighted path 
history technique of Figure 19, the value reflects the number of first position estimates that have been taken thus 
far, and therefore, it reflects the statistical accuracy of a future prediction from the path equation. 

If the R2 value is not greater than or equal to 0.98, then a test is performed at a flowchart block 1 910 to determine 
whether a new path equation should be derived. In other words, a detemiination is made as to whether the currently 
collected first position estimates as well as the path equation are inaccurate, and therefore, should not be relied upon. 

In the preferred embodiment, the number of first position estimates is counted and compared to a threshold of 20. 
Any threshold number could be preselected. If more than 20 first position estimates have been computed, then the 
flowchart moves to block 1914. Flowchart block 1 91 4 indicates that a new path equation will be started during the next 
iteration of the flowchart 1900 at flowchart block 1 906. 

If less than or equal to 20 first position estimates have been calculated and collected, then the present path equation 
of flowchart block 1 906 is still utilized and will be considered again during the next iteration of flowchart 1 900. Moreover, 
the first position estimate is outputted from the GPS processing system 700. as shown at a flowchart block 1912. 

Referring back to the flowchart block 1908, if the R2 value of the path equation is greater than or equal to 0.98, 
then as shown in a flowchart block 1916, the first position estimate is modified to be the best tit prediction from the 
present path equation. Finally, the first position estimate is outputted by the GPS processing system 700, as shown 
by flowchart block 1912. 

Figure 20 illustrates graphically the scenario at issue. The first position estimate 201 0 of the vehicle 1 02 is radically 
different from the best fit prediction 2006 of the path equation. Therefore, the first position estimate 2010 is replaced 
by best fit prediction 2006, so long as the R2 value of the path equation is greater than or equal to preselected threshold 
and so long as enough position estimates have been sampled. 

Lines 2014 and 2016 illustrate the scope of acceptability with respect to the first position estimates. These lines 
2014 and 2016 represent the physical manifestation of the R2 value. Thus, the best fit prediction 2006 is outputted 
from the GPS processing system 700 to the navigation system 1022. instead of the first position estimate 2010 which 
is outside the span of line 2016. 

Figure 20A shows a high level flowchart 2000A of a method for implementing the weighted path history technique 
as disclosed in Figures 1 9 and 20. The method as shown accommodates for a vehicle travel path having sharp corners, 
intersections, and/or any drastic nonlinear path. The method increases the accuracy of the first position estimate (FPE) 
of the vehicle 102 outputted by the GPS processing system 700. 

The preferred embodiment implements the novel methodology of Figure 20A via software. The software can be 
situated in the GPS processor 710 ot the GPS processing system 700 at the vehicle 102 and/or at the base station 188. 

The flowchart 2000A begins at flowchart block 2001 and ends at flowchart block 201 9. As shown in flowchart block 
2005, the GPS processing system 700 as disclosed in Figures 7 and 8 computes the first position estimate using any 
of the bias techniques discussed previously in this document. In the preferred embodiment, the bias techniques subject 
to the method of Figure 20A include, for example, the original bias technique of Figure 15 and the parabolic bias 



25 



EP 0 604 404 B1 



technique o1 Figure 16. . j, , 

At flowchart block 2009. a decision is made as to whether the vehicle 102 is approaching or is in the midst ot a 
sharp comer, intersection, or other irregular path. The information needed to answer this question can be supplied to 
the GPS processor 710 from the navigator 405 of Figure 4. If the answer to this question is in the negative, then the 
5 flowchart 2000A proceeds as indcaled by an arrow 201 3. In the alternative, that is. if the answer to this question is in 
the affirmative, then the flowchart 2000A proceeds as indicated by an arrow 2021 . Both of these alternative avenues 

are discussed in detail below. u -onnn* 

When the vehicle 102 is not approaching or is not in the midst of a drastc nonlinear path, then the flowchart 2000A 
commences with flowchart block 201 5. At flowchart block 2015, the GPS processor 710 outputs the first position es- 
10 timate to the VPS 1 000, which first position estimate was derived using one or more bias techniques. Recall that tne 
VPS 1000, which is disclosed in Figures 10 and 11, calculates the third position estimate of the vehicle 102 using, in 
part the first position estimate sent to it from the GPS processing system 700. 

When the vehicle 1 02 is approaching a drastic nonlinear path, then the flowchart 2000A commences with flowchart 
block 2023 Atflowchart block 2023, the bias techniques are temporarily abandoned, until a more linear path ultimately 
15 ensues. The GPS processor 710 computes the first position estimate of the vehicle 102 without regard to the bias 
techniques, as indicated in flowchart block 2027. u- ,no ic 

The flowchart next proceeds to flowchart block 2031. A determination is made as to whether the vehicle 102 is 
approaching or is in the mkist of a relatively linear path. If so. then the flowchart 2000A returns to flowchart block 2005. 
as shown by a feedback arrow 2033. At the flovw:hart block 2005. any prevrausly-temiinated bias techniques are again 

20 instituted. . * 

m the case o1 the parabolic bias technique of Figure 16, new best-fit parabolic nnodels are constructed ior each ot 
the observed GPS satellrtes. Recall that actual pseudoranges are determined for each of the observed GPS satellites 
over a period of time to construct a parabolic model for each GPS satellite. The parabolic models are not utilized unt 
the accuracy of the models is greater than a certain threshold. In the present invention, the parabolic models are not 
25 utilized until a statistical Revalue is greater than 0.99. 

Alternatively, if the vehicle 1 02 is not approaching or is not in the midst of a relatively linear path, then the flowchart 
2000A moves to flowchart block 201 5 discussed previously. However, it should be noted that the first position estimate 
transmitted to the VPS 1000 at this point was derived without regard to any bias techniques. 

30 I. Anti-Selective Availability 

It is believed that the U.S. government (the operator of the NAVSTAR GPS) may at certain times introduce errors 
into the GPS data being transmitted from the GPS satellites 1 32-170 by changing clock and/or ephemeris parameters. 
In other words the U.S. government can selectively modify the availability of the GPS data. For example, such an 
35 action might take place during a national emergency The U.S. government would still be able to use the NAVSTAR 
GPS because the U.S. government uses the other distinct type of pseudorandom code modulation, called the P- mode. 
Thus the U S government could debilitate the C/A mode. Such debilitation could cause the GPS receiver 706 to 
compute incorrect actual and estimated pseudoranges, and thus, incorrect first position estimates. The anti^elective 
availability technique of the present invention is a way to detect and compensate for any misleading GPS data. 
40 Turning now to Figure 21 . a flowchart 2100 of the anti-selective availability technique is depicted. In the preferred 

embodiment, the anti-selective availability technique is performed in the GPS processor 710 of the host processing 
system 186. However, the technique could be implemented in the GPS processor 71 0 at the vehicle 102. The flowchart 
2100 begins at a flowchart block 2102 and ends at flowchart block 2119. 

At a flowchart block 2104, estimated pseudoranges (predicted estimated pseudoranges; "Oij") of GPS satellites 
45 in view of the GPS antenna 702 are predicted by using old almanac data. Old almanac data is GPS data, or any part 
thereof, which has been previously recorded by the GPS receiver 706 and which enables the GPS processor 710 to 
compute predicted estimated pseudoranges without regard to the currently-received GPS data. In a sense, the old 
almanac data is used to check the integrity ot currently-received GPS data. In the preferred embodiment, the old 
almanac data is the previous ephemeris which was received by the GPS receiver 706. 
so With further reference to the flowchart block 2104. current estimated pseudoranges ('Nij") of the GPS satellites 

are computed in the usual fashion using the current ephemeris data (subset of GPS data) being transmitted by the 
GPS satellites and the base known position of the base station 183. 

At a flowchart block 2106, the predicted estimated pseudoranges (using the almanac) and the current estimated 
pseudoranges (using the latest ephemeris data) are compared. As is shown in the flowchart block 2106, the euclidian 
55 norm of the predicted estimated pseudoranges and the current estimated pseudoranges are computed and tested 
against a preselected threshold. 

If the euclidian norm is larger than the preselected threshold, then the ephemeris data is deemed to be corrupted, 
as shown at a flowchart block 2108. Consequently, the latest valid almanac data is used instead to compute position 
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estimates of the base station 188, as shown at a flowchart block 2108. The flowchart 2100 then continues to flowchart 
block 2110 

If the eucltdian norm is less than or equal to the preselected threshold, then the ephenneris data is deenned to be 

proper and the flowchart 21 00 continues to flowchart block 2110. 
s Next, as shown at a flowchart block 2110, the base position estimate of the base station 188 is computed using 

the current time and either the currently received GPS data or the old almanac data (decided in flowchart block 2106). 
At a flowchart bkx;k 2112, the base position estimate is tested against expected values. In other words, because 

the location (base known position) of the base station 188 is known, the accuracy of the base position estimate using 

the anti-selective availability technique can be readily tested against a preselected threshold. 
JO If the accuracy is within the preselected threshold, then the an indication is sent to the vehicle 102 that the GPS 

data is proper, as shown at a flowchart block 2116. As a result, the base station 183 fonwards any infomnation needed 

by the vehicle 102 in order to compute first position estimates. The information forwarded could Include, for example. 

base clock biases, spatial biases (original biases, parabolic biases, base residuals biases), base estimated pseudor- 

anges, and/or base actual pseudoranges. 
J5 If the computed base statbn 188 is not within preselected threshold, then base clock biases and/or base spatial 

biases are manipulated so that the estimated base position is within the preselected threshold, as shown at a flowchart 

block 2114. The base clock biases needed to bring the base estimated positkxi within the threshold of acceptability 

are then sent to the vehicle 1 02, as indicated at the flowchart block 2116. 

20 J, Surveying 

In addition to the determination of position estimates and navigation of the vehicle 102, the present invention can 
be used in a separate embodiment to accomplish sun/eying of the Earth 172's surface in real time. Thus, the position 
of any point on the Earth 172 can be computed using the techniques and methods of the present invention, 

25 

K. Graphic Representations 

The present invention provides for the production of graphic images on the user interface (not shown) of the host 
processing system 1 88. The graphic images allow human users at the base station 1 88 to view the paths of the vehicle 
30 1 02 as well as any other vehicles which are being navigated with the present invention. In the preferred embodiment, 
the graphic images are displayed on commercially available video displays and, if desired, the screens can be printed 
by conventional printers. 

35 Claims 

1 . A method for improving the accuracy o1 terrestrial position estimates of a user antenna (31 2) located on a vehicle 
based on pseudoranges derived from satellites (132-170,200-206) of a global position system, the method com- 
prising the steps of: 

40 

obtaining a known position of a reference antenna (316): 

receiving electromagnetic signals at the reference antenna from a constellation of satellites and responsively 
determining respective reference antenna pseudoranges .(Ro-Ri-Ra.Ra); 

determining an estimated position of the reference antenna using the reference antenna pseudoranges; 
comparing the estimated position of the reference antenna with the known position of the reference antenna 
to derive a spatial bias; 

transmitting the reference antenna pseudoranges and the spatial bias to the vehicle; 
receiving electromagnetic signals at the user antenna on the vehicle, receiving the reference antenna pseu- 
doranges and the spatial bias at the vehicle and responsively determining a position estimate of the vehicle 
as a function of the spatial bias and the electromagnetic signals; 

at the vehicle, determining another estimate of the position of the reference antenna as a function of the 
reference antenna pseudoranges; 

determining an offset as a function of the another estimate of the position of the reference antenna and the 
known position of the reference antenna; and 

updating the position estimate of the vehicle as a function of the offset; and 

repeating the second vehicle position estimate determining step and offset determining step until the offset is 
less than a predetermined threshold. 



so 
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2. A method (or improving the accuracy ol terrestrial position estimates of a user antenna (31 2) located at a vehicle, 
the method comprising the steps of: 

obtaining a known position of a reference antenna (316); 
5 receiving electromagnetic signals at the reference antennaf rom a constellation of satellites (1 32-170,2OO-2Ob) 

and responsively determining respective reference antenna pseudoranges; 

computing an estimated position of the reference antenna using the reference antenna pseudoranges (Rq.h, , 

Smpting the estimated position of the reference antenna with the l«iown position of the reference antenna 
10 to derive a base residuals bias; 

transmitting the base residuals bias and the reference antenna pseudoranges to the vehicle, 

receiving electromagnetic signals at the user antenna, receiving the base residuals bias and the reference 
antenna pseudoranges at the vehicle, and computing future user pseudoranges as a function of the base 
residuals bias; 

IS determining a position estimate of the vehicle as a function of the future user pseudoranges. 

at the vehicle, detemiining another estimate of the position of the reference antenna as a function of the 
reference antenna pseudoranges; . . „^ fh= 

determining an offsetas a (unction of the another estimate of the position of the reference antenna and the 

known position of the reference antenna; 
20 updating the position estimate of the vehicle as a function of the offset; and 

repeating the second vehicle position estimate determining step and offset determining step until the offset is 
less than a predetennined threshold. 



2S Patentanspruche 

1 Verfahren zur Verbesserung der Genauigkeit terrestrischer PositionsschaUungen einer Benutzerantenne (312) 
■ angeordnet auf einem Fahrzeug, und zwar basierend auf von Satelrten (1 32-170, 200-206) eines globalen Posi- 
tionssystems abgeleiteten Pseudobereichen wobei das Verfahren die folgenden Schritte vorsieht; 

30 

Erhalt einer bekannten Position einer Bezugsantenne (316); Empfang von elektromagnetischen Signalen an 
der Bezugsantenne von einer Konstellation von Salelilen und darauf ansprechendes Bestimmen von entspre- 
chenden Bezugsantennen Pseudobereichen (Rq, Rv Ra^ ^s)' 

Bestimmung einer geschatzten Position der Bezugsantenne unter Verwendung der Bezugsantennenpseudo- 

35 bereiche; . „ . 
Vergleichen der geschatzten Position der Bezugsantenne mit der bekannten Position der Bezugsantenne, um 

eine raumliche Vorspannung abzuleiten; 

Ubertragen oder Senden der Bezugsantennenpseudobereiche und der raumlichen Vorspannung zu dem Fahr- 

zeug' 

40 Empfang elektromagnetischer Signale an der Benutzerantenne am Fahrzeug. Emptang der Bezugsantennen- 

pseudobereiche und der raumlichen Vorspannung am Fahrzeug und darauf ansprechende Bestimmung einer 
Positionsschatzung des Fahrzeugs als einer Funktion der raumlichen Vorspannung und der elektromagneti- 
schen Signale; 

Bestimmung. am Fahrzeug. einer weiteren Schatzung der Position der Bezugsantenne als Funklion der Be- 
45 zugsantennenpseudobereiche; 

Bestimmung einer Versetzung (offset) als einer Funktion der weiteren Schatzung der Position der Bezugsan- 
tenne und der bekannten Position der Bezugsantenne; und 

auf den neuesten Stand bringen (updating) der Positionsschatzung des Fahrzeugs als einer Funktion der 
Versetzung; und 

50 Wiederholung des zweiten Fahrzeugpositbnsschatzungsbestimmungsschrtttes und des Versetzungsbestim- 

mungsschrittes bis die Versetzung kleiner ist als eine vorbestimmte Schwelle. 

2. Verfahren zur Verbesserung der Genauigkeit von terrestrischen Positionsschatzungen einer Benutzerantenne 
(312) angeordnet an einem Fahrzeug. wobei das Verfahren die folgenden Schritte aufweist: 

55 

Erhalt einer bekannten Position einer Bezugsantenne (316); 

Empfang elektromagnetischer Signale an der Bezugsantenne von einer Konstellation von Sateliten (132-170. 
200-206) und darauf ansprechende Bestimmung der entsprechenden Bezugsantennenpseudobereiche; 
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Berechnen einer Schatzposition der Bezugsantenne unter Verwendungder Bezugsantennenpseudobereiche 
(Rfl. f^v ^3) 

Vergleichen der geschatzen Positron der Bezugsantenne mit der bekannten Position der Bezugsantenne zur 
Ableitung einer Basisrestevorspannung; 

Senden oder Ubertragen der Basisrestevorspannung und der Bezugsantennenpseudobereiche zu dem Fahr- 
zeug; 

Ennptang von elektromagnetischen Signalen an der Benutzerantenne, Ennpfang der Basisrestevorspannung 
und der Bezugsantennenpseudobereiche am Fahrzeug, und Berechnen von zukunftigen Benutzerpseudobe- 
reichen als einer Funktion der Basisrestevorspannung; 

Bestimmen einer Positionsschatzung des Fahrzeugs als Funktion der zukunftigen Benutzerpseudobereiche; 
Bestinnmung, am Fahrzeug, einer weiteren Schatzung, der Position der Bezugsantenne als Funktion der Be- 
zugsantennenpseudobereiche: 

Bestimmung einer Versetzung (offset) als eine Funktion der anderen Schatzung der Position der Bezugsan- 
tenne und der bekannten Position der Bezugsantenne; 

auf den neuesten Stand bnngen der Positionschatzung des Fahrzeugs ats einer Funktion der Versetzung; und 
wiederholen des zweiten Fahrzeugpositionsschatzbestimmungsschrittes und Versetzungsbestimmungs- 
schrittes bis die Versetzung kleiner ist als eine vprbestimmte Schwelle. 

Revendications 

1. Precede pour ameliorer la precision d'une estimation de position terrestre d'une antenne utilisateur (312) situ6e 
sur un vehicule, en se basant sur des pseudo-distances obtenues a partir de satellites (132-170, 200-206) d'un 
systeme de position nement global, comprenant las etapessuivantes: 

obtenir une position connue d'une antenne de reference (316) ; 

recevoir des signaux eleclromagnetiques au niveau de I'antenne de reference depuis une constellation de 
satellites et deternniner en reponse les pseudo-distances respectives de I'antenne de reference (Rq, R,, R2, 
R3): 

determiner une position estimee de I'antenne de reference en utilisant les pseudo-distances de I'antenne de 
reference ; 

comparer la position estimee de I'antenne de reference a la position connue de I'antenne de reference pour 
en deduire un decalage spatial ; 

transmettre les pseudo-distances de I'antenne de reference et le decalage spatial au vehicule ; 
recevoir des signaux electromagnetiques au niveau de I'antenne utilisateur du vehicule, recevoir les pseudo- 
distances de I'antenne de reference et le decalage spatial au niveau du vehicule et determiner en reponse 
une estimation de position du vehicule en fonction du decalage spatial et des signaux electromagnetiques ; 
au niveau du vehicule, determiner une autre estimation de la position de I'antenne de reference en fonction 
des pseudo-distances de I'antenne de reference ; 

determiner un ecart en fonction de I'autre estimation de la position de I'antenne de reference et de la position 
connue de I'antenne de reference ; et 

mettre a jour I'estimation de position du vehicule en fonction de I'ecart ; et 

renouveter ta deuxieme etape de determination de Testimation de la position du vehicule et I'etape de d6ter- 
minatbn de I'ecart jusqu'a ce que I'ecart soit inferieur a un seuil predetermine. 

2. Precede pour ameliorer la precision d'une estimation de position terrestre d'une antenne utilisateur (312) situee 
sur un vehicule, comprenant les etapes suivantes : 

obtenir une position connue d'une antenne de reference (316) ; 

recevoir des signaux electromagnetiques au niveau de I'antenne de reference depuis une constellation de 
satellites (1 32 a 1 70, 200 a 206) et determiner en reponse des pseudo-distances correspondantes de I'antenne 
de reference ; 

calculer une position estimee de I'antenne de reference en utilisant les pseudo-distances de I'antenne de 
reference (Rq, R,, Rg, R3) ; 

comparer la position estimee de I'antenne de reference a la position connue de I'antenne de reference pour 
en deduire un decalage residuel de base ; 

transmettre le decalage residuel de base el les pseudo-distances de I'antenne de reference au vehicule ; 
recevoir des signaux electromagnetiques au niveau de I'antenne utilisateur, recevoir le decalage residuel de 
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base et les pseudo-distances de I'antenne de reference au niveau du vehicule. et calculer de futures pseudo- 
distances de Tutilisateur en tonction du decalage residuel de base ; 

determiner une estimation de position du vehicule en tonction des futures pseudo-distances de Tutilisateur ; 
au niveau du vehicule. determiner une autre estimation de la position de I'antenne de reference en tonction 
s des pseudo-distances de I'antenne de reference ; 

determiner un ecart en fonction de I'autre estimation de la position de I'antenne de reference et de la position 
connue de I'antenne de reference ; 

mettre k jour restimation de position du vehicule en fonction de i'6cart ; et 

rep6ter la deuxieme etape de determination de la position du vehicule et I'etape de detemiination du decalage 
70 jusqu'^ ce que le decalage soit inf erieur a un seuil predetemiine. 
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